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(54) CONTROLLER FOR LEGGED MOBILE ROBOT 



by the actual foot floor reaction force are contfx>iled In- 
dependently. With this, the system can appropriately 
control the actual total floor reaction force and the actual 
foot floor reaction force acting on the biped mobile robot, 
can realize wailcing with stable posture even when walk- 
ing on the floor having not only a slant or undulation ex- 
tending over a relatively long distance, but also on an 
unexpected local slant or level difference, and can ab- 
sorb the foot-landing impact to knprove the contadabll- 
tty of robot foot with the ftoor. Moreover, the system can 
prevent the spinning from happening and decrease the 
toad to be exerted on the Joint actuators. 



FIG. 4 




(57) The posture Inclination of the robot is detected, 
a moment of compensating total floor reaction force 
about a desired total floor reaction force central point is 
determined therefrom to be distributed to each foot such 
that the position/posture of the feet are rotated by pre- 
determined amounts about the desired total floor reac- 
tion force central point and a desired foot floor reaction 
force central points respectively. And by parallel-trans- 
lating the feet In phase, the force component of the ac- 
tual total floor reaction force Is also controlled. In addi- 
tion, the internal force components (whksh do not Influ- 
ence on the actual total floor reaction force) generated 
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Description 

TECHNICAL FIELD TO WHICH THE INVENTION RELATES 

[0001] TYie prosent Invention relates to a control system of a legged mobile robots specifically to a posture control 
system of a legged mobile robot, and more specif loally a system for conducting a compliance control on the motion of 
the legs of a legged mobile robot. In particular a biped robot, and controls the floor reaction foroe acting on the robot 
appropriately. 

BACKGROUND ART OF THE INVENTION 

[0002] A simplest control system of a legged mobile robot. In particular a biped robot comprises a desired motion 
pattem generator and a Joint drive controller. The desired motion pattern generator generates at least a desired motion 
pattem. Normally, the desired motion pattem Is generated In such a manner that a ZMP trajectory, obtained therefrom 
by conducting a dynamics calculation thereon. I.e., by soh/ing the Euler-Newton equation, tract<s a predetemnlned 
desired trajectory. The Joint drive controller controls to drh/e the robot joints such that the joint displacement tracks the 
joint displacement command of the respective Joints generated by the generator 

[0003] Here, the ZMP (Zero Moment Point) Is used in this specification to Indicate a floor point at which the moment 
components, except for the vertical component, of the resultant foroe (of the Inertlal force and the gravity generated 
by the robot motion) are both zero. 

[0004] In such a control system, if the generator anticipates the floor flat and generates a gait suitable therefor, the 
floor may In fact have a slant as illustrated in Figure 41 . If the robot foreleg foot lands on the unexpected slant at the 

beginning of the two-leg supporting pen'od, the foot generates an excessive floor reaction force greater than that an- 
ticipated, causing the robot to tilt. In order to solve this problem, the applicant proposed. In Japanese Laid-Open Patent 
Application Hel 5 (1993) - 305,586, a control system for a biped robot of this kind. 

[0005] In the proposed system, the robot body inclination Is detected to determine a moment-restoring-demand value, 
while the moment component of the actual total floor reaction force about a desired total floor reaction force central 
point (the central point of the total floor reaction force; a desired ZMP) is detected, and the robot feet are controlled to 
move up and down and rotate such that the detected moment component of the actual total floor reaction force becomes 
equal to the moment-restoring-demand value. The moment component of the actual total floor reaction force Is a 
moment which the resultant force of alt of the foot floor reaction forces of the feet generates about the desired total 
floor reaction force central point (i.e., the desired ZMP). 

[0006] Taking as an example the case illustrated In Figure 41 in which the floor has the unexpected slant, the control 
system proposed earlier by the applteant will be explained. (The control of the system will be hereinafter referred to as 
"two'leg^ompiiance control".) For ease of understanding, each foot is assigned with a reference numeral, as illustrated 
in the figure. It is assumed here that, although the gait generator anttelpates the floor flat and generates a gait suitable 
therefor, the floor has, In fact, the slant as illustrated In Figure 41, and hence, since Uie robot foreleg foot (Ist foot) 
lands on the unexpected slant at the beginning of the two-leg supporting period, the foot generates an excessive floor 
reaction foroe greater than that anticipated. It is also assumed that the robot stifl keeps, at that instant, a desirable 
posture (Le.. the body Inclination zero). 

[0007] in the proposed control system, the actual total floor reaction force's moment about the desired total floor 
reactton force central point (I.e.. the desired ZMP) is detected. At that situation, since the ve|rtk;al component of the 
floor reaction force of the 1 st foot is excessive, the actual total floor reaction force's moment acts In the dlrectk>n to tilt 
the robot backward. 

[0008] In the proposed control system. In order to decrease the moment to zero, a virtual floor A-A' Is supposed, as 
illustrated In Figure 42, and the virtual plane Is supposed to be rotated by an angle AO about the desired total floor 
reactton force central point (desired ZMP) and each foot Is supposed to be on the virtual plane such that the feet are 
moved to the positions on the virtual floor. 

[0009] With this, the vertical connponent of the t st foot floor reaction force decreases, while the vertical component 
of the 2nd foot floor reaction force Increases. As a result, the actual total floor reaction force's moment about the desired 
total floor reaction force central point (desired ZMP) becomes almost zero. Thus, even If the floor has an unexpected 
slant, this two-leg-compliance control can ensure that the robot continues walking without tipping over. 
[0010] However, the proposed technique can not control the actual floor reaction force acting on each foot during 
the two-teg supporting period If the floor has an unexpected local slant or bump, the robot Is likely to spin or may tip 
over due to drastic posture change. 

[0011] lb bemorespecifk:. as itiustratedin Figure 43. if there exists an unexpected protmslon or step (level difference) 
on the floor at a position at which the robot 1st foot toe Is scheduled to land In the two-leg supporting period, since the 
1st foot toe Is controlled to be driven downward In the two-leg supporting period, the Ist foot toe will stomp on the 
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projection, causing the vertical component of the 1 st foot floor reaction force to grow drastically. As a result, this suddenly 
generates the actual total floor reaction force's nioment about the desired total floor reaction force central point (desired 
ZMP). The two-leg-compliance control would sometimes t>e late In restoring the posture and at worst, the robot tums 
over. 

5 [001 2] Even If the robot did not turn over during the two-leg supporting period, when the second foot is lifted, although 
the desired total floor reaction force central point (desired ZMP) Is set at the heel of the 1st foot, since the 1st foot heel 
Is not on the floor, the actual total floor reaction force central point shifts to its toe. The generated actual moment of 
total floor reaction force about the desired total floor reaction force central point (desired ZMP) will tilt the robot baclcward 
and cause the robot to tum over. 

10 [001 3] It could be stated from the above that the two-leg-compiiance control can effectively cope with an unexpected 
slant or undulation extending over a retativeiy long distance, but can not cope with an unexpected local slant or level 
difference existing at a position at which the robot foot will land. 

[0014] Aside from the aforesaid two-leg-compliance control system, the applicant proposed, in Japanese Laid*Open 
Patent Application No. IHei 6 (1993) - 305,584, etc.. another control system which has a foot-landing-impact-absorber 
^5 made of a material such as rubber with a springy property. In this control system, actual foot floor reaction force's 
moment acting about the ankle of each robot foot Is detected and an anicle compliance control to rotate the foot ankle 
such that the detected moment becomes zero, is effected. 
, ^ [0015] In order to solve the problem mentioned above, it is therefore possible to combine this control disclosed In 

Japanese Laid-Open Patent Application No. Hei 5 (1 993)-d05, 564 (hereinafter referred to as "ankle-compliance con- 
20 trol") to the two-leg-compi lance control. 

[0016] If the two kinds of control are used, it will be possible to rotate the 1st ankle in the direction in which the 
unexpected moment of the 1st foot floor reaction force is canceled, as Illustrated in Figure 44, such that the 1st foot 
heel lands on the floor. Accordingly, the robot will not turn over when the phase shifts to the succeeding one-leg sup- 
porting period. 

^9 [0017] However, if the two-ieg-compiiance control and the ankle-compliance control are simply combined to be used, 
the two kinds of control interfere, with each other £md cause either or t>oth of the total floor reaction force and the foot 
floor reaction force to deviate from desirable values or control oscillates. 

[0018] An object of the present invention is to solve the drawbacks and to provide a control system for a legged 
mobile robot which can ensure to control the actual floor reaction force acting on the robot easily and appropriately, 

3o while preventing the problem of interference from occurring. 

[0019] Further, if the robot walks on the floor whose level is different than expected, i.e. whose level is lower than 
expected, the acceleration of the body may become excessive, resulting in the increase in the foot-landing Impact. In 
addition, the robot has the natural vibration determined by its own mechanism and mass, which causes the robot to 
displace in the vertical direction. The magnitude of the displacement caused by the natural vibration is slight, but It 

^9 may sometime degrade the contactability of the robot foot with the floor. It is therefore preferable to conduct a compli- 
ance control on the force components of the actual floor reaction force acting on the robot. 

[0020] A second object of the present invention is to provide a control system for a legged mobile robot which can 
ensure to absoris the foot- tan ding impact and enhance the contactability of the robot foot with the floor by conducting 
a compliance control on the force components of the actual floor reaction force acting on the robot. 
^ 40 [0021] A third object of the present invention Is to provide a control system for a legged mobile robot which can 
> ensure to control the floor reaction force acting on the robot appropriately, even when walking on the floor having not 

only a slant or undulation extending over a relatively long distance, but also on an unexpected local slant or level 
difference, without being affected thereby. 

[0022] A fourth object of the present invention is to provide a control system for a legged mobile robot which can 
45 ensure to control the floor reaction force acting on the robot appropriately such that a posture stabilization control of 
a legged mobile robot Is facilitated. 

[0023] A flfth object of the present Invention Is to provide a control system for a legged mobile robot which can ensure 
to control the floor reaction force acting on the robot appropriately such that the contactability of robot foot with the 
floor is enhancedso as to prevent the slippage and the aforesaid spinning that can occur during walking from happening. 

59 [0024] Further, by controlling the force component of the actual foot floor reaction force acting on each robot foot 
Independently, for example, by increasing the force to propel the robot In the advance direction for the foot whose floor- 
contact pressure is high, while decreasing that for the foot whose floor^ontact pressure is low, It becomes possible to 
enhance the posture stability of the robot such that.the slippage can eflectively be suppressed. Furthennore, by con- 
trolling the force component of the actual foot floor reaction force acting on each robot foot appropriately, it fc>ecomes 

^ possible to prevent one foot being a toad to the force to be generated by the other foot to propel the robot In the 
advancing direction and some similar problems, thereby enabling to decrease the load to be exerted on Joint actuators. 
[0026] A sixth object of the present Invention Is to provide a control system for a legged mobile robot which can 
ensure to control the force component of the actual foot floor reaction force acting on each robot foot Independently 
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such that the posture stability of the robot is enhanced and the load to be exerted on the Joint actuators is decreased. 
[0026] A seventh object of the present invention Is to provide a control system for a legged mobile robot which can 
ensure to control the floor reaction force acting on the robot appropriately such that the load to be exerted on actuators 
of the robot is decreased. 

9 

DISCLOSURE OF THE INVEI^ON 

10027] In order to achieve the above-mentioned objects, the present invention Is configured to have a system for 
controlling a legged mobile robot having at least a body and a plurality of legs each connected to the body through a 

^0 first Joint and having a foot connected to Its distal end through a second Joint, comprising: gait generating means For 
generating a gait of the rot)ot including at least a motion pattern including at least a desired position and a posture of 
the foot, and a desired pattern of a total floor reaction force acting on the robot: desired foot floor reaction force central 
point determining means for determining a desired foot floor reaction force central point indicative of a point of action 
on the foot when the total floor reaction force in the generated gait Is distributed to each of the feet; actual floor reaction 

^9 force detecting means for detecting an actual floor reaction force acting on the foot; foot rotating amount detennnlnlng 
means for detemrilning a foot rotating amount for rotating the foot based on at least the detected actual floor reaction 
force; first foot posltlon/|posture correcting means for correcting the desired position and/or the posture of the foot such 
that the position and/or the posturs of the foot rotates based on the determined foot rotating amount; compensating 
displacement calculating means for calculating a compensating displacement of the foot based on at least the detected 

20 actual floor reaction force; second foot position/posture correcting means for correcting the desired position and/or the 
posture of the foot based on the calculated compensating displacement; and Joint displacement means for displacing 
the first Joint and the second Joint of the robot based on at least the corrected position and/or posture of the foot 
corrected by the first foot position/posture correcting means and the second foot position posture correcting means. 
10028] Further, the system is configured such tiiat the foot rotating amount detemnining means calculates a moment 

S9 acting about the detenmined desired foot floor reaction force central point and determines the foot rotating amount fbr 
rotating the foot based on at least the calcuiated moment, and the compensating displacement calculating means 
determines a force component of an actual total floor reaction force based on the detected actual floor reaction force 
to catculate an error between the determined force component and a force component of the total floor reaction force 
in the generated gait and calculates the compensating displacement based on the calculated error. 

39 [0029] Further, the system Is configured such that the first foot position/posture correcting means corrects the desired 
position and/or the posture of the foot based on the determined foot rotating amount such that tiie position and/or the 
posture of the foot rotates ak>out the desired foot floor reaction force central point or thereabout. 
P)030] Further, the system is configured such that the first foot position/jsosture correcting means corrects the desired 
position and/or the posture of the foot based on the detennined foot rotating amount such that the position and/or the 

39 posture of the foot rotates about the desired foot floor reaction force central point or thereabout. 

[0031] Further, the system Is configured such that it lncludes:foot moving amount determining means for determining 
at least one of a moment of total floor reaction force actually acting on the robot, and a moment obtained by subtracting 
a moment of the tioor reaction force acting on the foot from the nnoment of total floor reaction force actually acting on 
the robot, and for detennining a foot moving amount for moving the foot based on at least the detenmined moment; 

49 and the first foot position/posture correcting means corrects the desired position and/or the posture of the foot based 
on the determined foot rotating amount and tiie determined foot moving amount 

[0032] Further, the system Is configured such that a moment of a compensating total floor reaction force for posture 
stabilization to be added to the desired pattern of the total floor reaction force is detennined, and the foot rotating 
amount detennining means and/or the foot moving amount determining means determines the foot rotating amount 
45 and/or the foot moving amount based on at least the detected actual floor reaction force and the determined moment 
of the compensating total floor reaction force for posture stabilization. 

[0033] Further, the system is configured such that the moment of the compensating total floor reaction force for 
posture stabilization Is detennined based on at least an inclination error of the robot. 

[P034] Further, the system is configured such that the compensating displacement calculating means includes: body 
89 €K»eieration detecting means for detecting a body acceleration of the robot; and compensating total floor reaction 
force's force component calculating means for calculating a force component of the compensating total floor reaction 
force for posture stabilization based on the detected body acceleration; and calculates the compensating displacement 
of the foot based on a difference obtained by subtracting the enror from the calculated force component of the com- 
pensating total floor reaction force. 
^ [0035] Further, the system is configured such that ttie compensating displacement calculating means distributes the 
compensating displacement of the fbot to each of the feet by muUplylng tiie difference by a predetemilned weight. 
[0036] Further, the system Is configured such that the compensating displacement calculating means malces the 
weight zero when the foot is lifted. 
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[0037] Further, the system Is configured such that the compensating displacement calculating means varies the 
weight in response to a frequency of the force component of the actual total floor reaction force. 
[0038] Further, the system is configured such that the displacement calculating means calculates the compensating 
displacement of the foot with respect to a direction of gravity. 
3 [0039] Further, the system Is configured such that the displacement calculating means calculates the compensating 
displacement of the foot with respect to a direction of a segment connecting a center of gravity of the robot and a 
desired total floor reaction force central point 

[0040] Further, the system is configured such that the force component of the compensating total floor reaction force 
is set to zero or thereabout 

10 [0041 ] Further, the system is configured such that the compensating displacement calculating means determines an 
internal force component, which does not Influence on an actual total floor reaction force, from the detected actual floor 
reaction force to calculate an error between the determined internal force component and an internal force component 
in the generated gait, and calculates the compensating displacement of each of the feet based on the calculated error. 
[0042] Further, the system is configured such that the foot rotating amount determining means determines the foot 

f 5 rotating amount for rotating the foot based on at least the detected actual floor reaction force, and the first foot position/ 
posture correcting means conrects the desired position anchor the posture of the foot based on the determined foot 
rotating amount such that the position and^or the posture of the foot rotates about the desired foot floor reaction force 
central point or thereabout. 

[0043] Further, the first foot position/posture correcting means corrects the desired position and/or the posture of 
the foot based on the determined foot rotating amount such that the position and/or the posture of the foot rotates 
about the desired foot floor reaction force central point or thereabout. 

[0044] Further, the system is configured such that it includes: foot moving amount determining means for determining 
at least one of a moment of total floor reaction force actually acting on the robot, and a moment obtained by subtracting 
a moment of the floor reaction force acting on the foot from the moment of total floor reaction force actually acting on 
S9 the robot, and for detenmining a foot moving amount for moving the foot based on at least the determined moment; 
and the first foot poslt'on/posture correcting means comects the desired position and/or the posture of the foot based ' 
on the determined foot rotating amount and the determined foot moving amount. 

[0045] Further, the system is configured such that a moment of a compensating total floor reaction force for posture 
stabilization to be added to the desired pattern of the total floor reaction force is determined, and wherein the foot ' 
30 rotating amount determining means and/or the foot moving amount detenmining means determines the foot rotating ' 
amount and/or the foot moving amount based on at least the detected actual floor reaction force and the detenmined 
moment of the compensating total floor reaction force for posture stabilization. 

[0046] Further, the system is cortfigured such that a moment of a compensating total floor reaction force for posture .. 
stabilization is detenmined based on at least an inclination error of the robot 
39 [0047] Further, the system is configured such that the compensating displacement calculating means distributes the 
compensating displacement of the foot to each of the feet by multiplying the difference by a predetermined weight. 
[0048] Further, the system Is configured such that the predetermined weight has time-varying characteristics and/or 
frequency characteristics. 

[0049] Having been configured in the foregoing manner, the system can control the floor reaction force acting on the 
^ legged mobile robot easily and appropriately, without causing the interference to happen. In other words, even if a 
control which is close to a combination of the two-leg-compliance control and the ankle-compliance control is conducted, 
no control interference occurs, the actual total floor reaction force and the actual foot floor reaction force do not deviate 
from desirable values, and no oscillation occurs. 

[0050] Further, the system can easily realize the posture stabilization control of a legged walking robot and can 
45 decrease the foot-tanding impact, thereby ensuring to enhance the contactability of robot foot with the floor and to 
prevent slippage or spinning that can occur during walking from happening. 

[0051] Further, the system can appropriately control the floor reaction force acting on the legged mobile robot, even 
when walking on the floor having not only a slant or undulation extending over a relatively long distance, but also on 
an unexpected local slant or level difference, without being affected thereby. The system can decrease the load to be 

so exerted on actuators of the legged mobile robot. 

[0052] Further, the system can control the floor reaction force acting on the legged mobile robot easily and appro- 
priately, without causing the interference from occurring, can easily realize the posture stabilization control and can 
decrease the foot-landing impact acting on the legged mobile robot, thereby ensuring to enhance the contactability of 
robot foot with the floor and to prevent slippage or spinning that can occur during walking from happening. 

5S [0053] Further, the system can appropriately control the floor reaction force acting on the legged mobile robot, even 
when walking on the floor having not only a slant or undulation extending over a relatively long distance, but also on 
an unexpected local slant or level difference, without being affected thereby. The system can decrease the load to be 
exerted on actuators of the legged mobile robot. 
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[P054] Further, in addition to the effects and advantages mentioned at)ove, the system can control the floor reaction 
force more appropriately. 

[0055] Further, in addition to the effects and advantages mentioned above, the system can control the floor reaction 
force which is particularly important for the posture control In a more appropriate manner 
^ [0056] Further. In addition to the effects and advantages mentioned above, the system can enhance the ability of 
posture stabilization. 

[0057] Further, in addition to the effects and advantages mentioned above, the system can absorb the foot-landing 
Impact more effectively and can further enhance the contactabillty of robot foot with the floor. 
[0058] Further, In addition to the effects and advantages mentioned above, the system can limit the control to a 
necessaiy extent so as to further decrease the load exerted on actuators. 

[0059] Further, In addition to the effects and advantages mentioned above, the system can effect a more stable robot 
posture. 

[0060] Further, in addition to the effects and advantages mentioned above, the system can decrease the volume of 
calculation. 

[0061] Further, in addition to the effects and advantages mentioned above, the system can realize the absorption of 
the foot-lEUiding impact and the enhancement of the contactabillty of robot foot with the floor to a fair extent and can 
simplify the system configuration. 

[0062] Further, in addition to the effects and advantages mentioned above, the system can control the floor reaction 
force acting on the legged mobile robot, without causing the Interference from occuning, easily and appropriately, in 
^ particular, by controlling the internal force components (a combination of components that does not Influence on the 
actual total floor reaction force) generated by the robot actual foot floor reaction force independently, the system can 
enhance the posture stability so as to prevent the slippage from happening and to decrease the load to be exerted on 
Joint actuators. 

[0063] Further, the system can appropriately control the floor reaction force acting on the legged mobile robot, even 
^5 when walking on the floor having not only a slant or undulation extending over a relatively long distance, but also on 
an unexpected local slant or level difference, without being little affected thereby. 

[0064] Further. In addition to the effects and advantages mentioned above, the system can Implement the distribution 
of the compensating displacement more appropriately. 

30 BRIEF DESCRIPTION OF THE DRAWINGS 

[0065] 

Rgure 1 1s a schematic view showing an overall configuration of a control system of a legged mobile robot according 

39 to the present invention; 

Rgure 2 Is an explanatory side view showing the structure of the foot of a biped robot Illustrated in Figure 1 ; 
Rgure 3 is a blocic diagram showing details of a control unit of the robot illustrated in Rgure 1 ; 
Figure 4 is a blocic diagram showing the configuration and operation of the control system of a legged mobile robot 
according to the present invention in a functional manner; 

40 FigureSareexplanatoryvlewsshowlngoneexampleofthemotionpattemoftherobot illustratedin Figurel when 
it wali(s on a flat floor; 

Rgure 6 is an explanatory plan view showing the trajectory of the desired total floor reaction force central point 
(desired ZMF) on the floor corresponding to the motion pattern illustrated in Figure 5; 

Rgure 7 is a time chart showing the trajectory of the desired total floor reaction force central point (desired ZMP) 

49 connesponding to the motion pattern illustrated in Figure 6; 

Figure 6 is a time chart showing the trajectory of the desired ist foot floor reaction force central point corresponding 
to the motion pattern Illustrated in Figure 5, which is set to satisfy predetemrilned conditions; 
Figure 9 Is a time chart showing the trajectory of the desired 2nd foot floor reaction force central point corresponding 
to the motion pattern illustrated in Figure 5, which Is set to satisfy the predetermined conditions; 

99 Figure 1 0 is a flow chart showing, similarly to Figure 4, the operation of the control system of a legged mobile robot 

according to the present invention; 

Rgure 11 is an explanatory view showing a situation that actual foot floor reaction force acts on each of the Ist 
foot and the 2nd foot during the two-leg supporting period, for explaining the operation of a composite compliance 
operation detenminator liiustnated In Figure 4, which conducts calculations of feet compensating angles, etc., re- 
f erred to in the flow chart of Figure 1 0, 

Figure 12 Is an explanatory view showing setting of the desired total floor reaction force In the situation Illustrated 
In Figure 11; 

Figure 13 is an explanatory view showing distribution of the desired foot floor reaction force In the situation illus- 
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trated In Rgure 1 1 ; 

Figure 14 Is an explanatory view showing the compensating total floor reaction force's moment In the situation 
lllustrBted In Figure 11; 

Figure 15 Is an explanatory view showing a vector V which Is normal on the plane that Includes the foot floor 
5 reaction force central point and Is perpendicular to the horizontal plane In the situation Illustrated In Figure 11 ; 

Rgure 1 6 is an explanatory view showing the desired foot floor reaction force central point rotated about the desired 
total floor reaction force central point (desired ZMP) by a predetermined angle Bdbv in the situation illustrated In 
Rgure 11; 

Figure 17 Is an explanatory view showing the feet each rotated about the back-and-forth-axis and left-and-rlght- 
w axis by predetennlned angles Onx, Ony in the situation as illustrated in Figure 1 6; 

Figure 1 8 Is ablocic diagram showing the calculation of the composite compliance operation determlnator illustrated 
in Figure 4; 

Rgure 1 9 Is a block diagram showing the calculation of a compensating total floor reaction force moment distributor 
Illustrated in Figure 18; 

f5 Rgure 20 Is a set of time charts each showing examples of set distribution-weight variables of the compensating 

total f kior reaction force moment distributor, illustrated in Rgurs 1 8, for manipulating the feet compensating angle; 
Rgure 21 Is an explanatory view showing the robot posture for explaining the setting of the distribution-weight 
variables of the compensating total floor reaction force moment distributor illustrated in Rgure 20; 
Rgure 22 is an explanatory view, similar to Rgure 21 , also showing the robot posturs for explaining setting of the 

so distribution-weight variables of the compensating total floor reaction force nnoment distributor, 

Rgure 23 is an explanatory view showing a V-dlrection-component of the feet compensating nrioment Mdmddbv 
when the distributor-weight variables for manipulating the feet compensating angle are detemilned under a pre- 
determined condition; 

Rgure 24 is a block diagram showing the cateulation of a feet compensating angle detenninator illustrated in Rgure 
^5 IB: 

Rgure 25 is a block diagram showing the caknjiation of foot compensating angle determlnators of each foot ilius- , 
trated in Rgure 18; 

Rgure 26 is an explanatory view showing the cateulation of a corrected desired feet position/posture with deform 
compensation calculator illustrated In Figure 18; 
30 Figure 27 Is an explanatory view, similar to Rgure 26, showing the calculation of a corrected desired feet position/ 

posture with defonn compensation calculator illustrated In Figure 1 8; 

Rgure 28 Is a flow chart showing the subroutine for determining the feet compensating angle, etc., refen^d to in 
the flow chart of Figure 10; 

Figure 29 Is an explanatory view, similar to Figure 1 6, but showing the operatk>n of a Z-direction body acceleratton 

39 controller Illustrated in Figure 4 and a in-phase compensating displacement cak^jlator Illustrated in Figure 1 8, and 
the processing In S31 and S36 of the fk)w chart of Figure 10; 

Rgure 30 Is a block diagram showing the processing of the In-phase compensating displacement cateulator illus- 
trated In Rgure 18; 

Figure 31 Is a flow chart showing the subroutine of the processing In S35 of the flow chart of Figure 1 0 and similarly 

40 showing the processing of the in-phase compensating displacement cak^ulator illustrated in Figure 18; 

Figure 32 is a set of explanatory views showing an example of presetting of weights to be used in the processing 
illustrated In Figure 30; 

Rgure 33 Is a set of explanatory views, similar to Rgure 32, but showing another example of presetting of the 
weights; 

Rgure 34 Is a btockdiagram, similar to Figure 4, but showing, In a functional manner, the configuration and operation 
of a control systsm of a legged mobile robot according to a second embodiment of the present invention; 
Figure 36 Is a flow chart, similar to Rgure 1 0, but showing the operation of the control system of a legged mobile 
robot according to the second embodiment, as well as Rgure 34; 

Rgure 36 is a block diagram showing the calculation of a composite compliance operation determlnator illustrated 
in Figure 34; 

Figure 37 is a block diagram showing the processing of an intemal force compensating displacement cateulator 
Illustrated In Figure 36; 

Figure 38 Is an explanatory view showing the processing Illustrated In the block diagram of Rgure 37; 
Rgure 39 Is a flow chart showing the processing of the Intemal force compensating displacement cateulator lllus- 
9^ trated In Rgure 36; 

Rgure 40 Is a set of explanatory views showing an example of presetting of weights to be used in the processing 
Illustrated In Figures 37 and 39; 

Figure 41 is an explanatory view showing a biped robot whose foot lands on an unexpected slant on a floor; 
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Rgure 42 is an explanatory view showing the two-leg-comptlance control, proposed by the applicant, applied to 
the biped robot in the situation Illustrated in Figure 41 ; 

Rgure 43 is an explanatory view, simliarto Rgure 41 , also showing the biped robot whose foot lands on an unex- 
pected projection on a floor, and 

9 Rgure 44 is an explanatory view showing the anide-compllance control, proposed by the applicant, applied to the 
biped robot in the situation illustrated in Rgure 43. 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIiWENTS 

10 10066] TTie control system of a legged nnobiie robot according to the present Invention wilt be explained with reference 
to the accompanied drawings. A biped robot is taken as an example of the legged mobile robot. 

[0067] Rgure 1 is a schematic view showing an overall configuration of the system according to the present Invention. 

fPOBB] As illustrated in the f^ure, a biped robot 1 has a pair of right and left leg links 2 each composed of six Joints. 

(In a simple representation, each of the Joints is represented by an electric motor which actuates the Joint.) The sbc 
f5 Joints include, anranged successively downwand, a pair of hip Joints 10R, 10L (the right-hand Joint is indicated by R and 

the left-hand Joint by L) for rotating legs with respect to hips, a pair of hip Joints 14R, 14L In the roiling axis (about an 

X-axis), a pair of hfp Joints 12R, 12L In the pitching axis (about a Y-axis), a pair of knee Joints 16R, ICL In the pitching 

axis, a pair of ankle Joints 18R. 18L In the pitching axis, and a pair of joints 20R 20L in the roiling axis. 

I0O69] Tlie robot Is provided with feet 22R, 22L undemeath of the joints 1 8R(L) and 20R(L). and a body (trunk) 24 
^ at its top which houses a control unit 26 comprising microcomputers (explained later). In the al>ove, the joints 10R(L). 

12R(L). 14R(L) make up the hp Joints, the Joint 16R(L) makes up the knee joint, and the Joints 18R(L), 20R(L) make 

up the ankle joints. The hip Joints and knee Joints are connected to each other by thigh links 28R, 28L, and the knee 

Joints and ankle Joints are connected to each other by crus or shank links 30R, 30L 

10070] With the above structure, each of the leg links 2 is given six degrees of freedom. When the 6 * 2 s 12 Joints 
^0 are driven to suitable angles during walking, a desired motion is imparted to the entire leg structure to cause the robot 
to walk arbitrarily in a three-dlmensionai (absolute) environment. (In the speclffcation, represents multlplteatten in 
scalar calculation and outer product in vector cakxilatlon.). 

[0071 ] It should be noted that the body position and velocity thereof Indicate the position and its displacement velocity 
of a predetermined position of the body 24, spedfk^liy a representath^e position such as the positk>n of the center of 
30 gravity of the body 24. 

[0072] As shown in Figure 1 , a known force sensor (more precisely, known as the six-axis force and torque sensor) 
44 is disposed at a position below each ankle Joint for measuring three directional components Fx, Fy, Fz of force and 
three directional conponents Mx, My, Mz of torque or nrnxnent theretyy of the force and outputs a signal indicative of 
foot landing and the floor reaction force (the load acting from the floor). 

39 [0073] Moreover, the body 24 has an inclination sensor 60 for detecting tipping or inclination in the frontal plane with 
respect to a Z-axis (the vertteal direction (the direction of gravity)) and Its angular velocity (yaw-rate), and also a tilt in 
the sagittal plane with respect to the Z-axIs and its angular velocity. The Inclination sensor 60 comprises an acceler- 
ometer and an angular velocity sensor and the accelerometer detects the acceleration of the body 24 In the directions 
of the X-axis, the Y-axis and the Z-axis. The electric motors of the respective Joints are coupled with respective rotary 

^ encoders for detecting angular displacements of the electric motors. 

[0074] As Illustrated In l=igure 2, a spring mechanism 32 is Installed at a position upward from the foot 22R(L). A sole 
elastic member 34 Is attached to the sole of the foot 22R(L). The spring mechanism 32 has a box-like guide member 
connected to the foot 22R(L), and a piston member connected to the sMe of the ankle Joint 1 8R(L). 20R(i^ and the 
force sensor 44 and inserted in the guide nnember with an elastic member such that it moves In the guide merTi>er to 

4^ a slight extent. 

[0076] In the figure, the foot 22R(L) Illustrated In thick lines shows the foot which is not subject to ttio floor readton 
force. When subjected to the f toor reaction force, the spring mechanism 32 and the sole elastic member 34 deform 
and the foot 22R(L) shifts to the position and/or posture Illustrated in dashed lines. This configuration is s^nifteant not 
only for decreasing the foot-landing impact, but also for enhancing the control performance. Since this configuration 
is disclosed in the aforesaid application (Japanese Lald-Open Patent Application No. Hel 5 (1993) - 305, 584), no 
further explanation will be made. 

[0076] Although not shown In Figure 1 , a Joystick 62 Is provided at an appropriate location of the biped robot 1 , whteh 
enables an operator from the outside to Input a request conceming the gait, such as switching from moving fonivard 
to turning. 

a* [0077] Rgure 3 Is a block diagram whteh shows the details of the control unit 26, which Is comprised of mterocom- 
puters. Outputs from the Inclination sensor 60, etc., are converted by an A/D converter 70 Into digital signals, whteh 
are transmitted through a bus 72 to a RAM 74. Output signals from the rotary encoders that are disposed adjacent to 
the respective electric motors are transmitted through a counter 76 to the RAM 74. 
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[0078] The control unit Includes a first calculator 80 and a second calculator 82 each comprising CPU. The first 
calculator 80 calculates Joint angle displacement commands (displacement command for the actuators), and outputs 
the same to the RAM 74. The second calculator 82 reads the desired command values and the detected Joint angles 
from the RAM 74. and calculates values (manipulated variables) and outputs the same through a Of A converter 86 
and servo-amplifiers to the electric motors which drive the respective Joints. 

[0079] Here, tenDS used In the specification and figures are defined as follows. (Terms not defined in the following 
are used in the meaning defined in an application (Japanese Patent Application No. Hel 8 (1 996) - 21 4, 261 ) proposed 
by the applicant separately of the aforesaid applications.) 

[0080] The term "gait" Is used to Indicate, different from that usually defined In the field of robotic engineering, what 

10 Includes the desired motion pattem and the floor reaction force pattem. The floor reaction force may be partial Infor- 
mation such as "only the ZMP trajectory", in other words, the tenn "gait generator' should not be used in the situation 
when only the desired nxition pattem, and not tlie infomiation concerning the floor reaction force pattem is outputted. 
[0081] Each of the feet is assigned with a reference numeral. The floor reaction force acting on n-th leg (n: 1 or 2) 
Is called "n-th foot floor reaction force". The resultant force of all of the foot floor reaction forces acting both feet (legs) 

15 is called "total floor reaction force". (Although, It is simply called floor reaction force In the field of robotic engineering, 
it Is called "total floor reaction force" here In order to distinguish from the (n-th) foot floor reaction force.) 
[0082] TTie foot floor reaction force Is described by a point of action and the force and the moment of force acting 
thereat A combination of descriptions will accordingly be Innumerable for a certain floor reaction force. The innumerable 
combinations of descriptions will surely include the combination of descriptions indicating that the moment components 

^ other than that about the vertical axis are zero and the point of action Is on the floor. The point of action in this combination 
of descriptions is called "foot floor reaction force central point". (This was called "the center of contact-pressure" in 
Japanese Laid-Open Patent Application Hel 6 (1 994) - 79,657 proposed by the applicant (referred to later)). 
[0083] Slmllariy, the total fioor reaction force is described by a point of action and the force and the moment of force 
acting thereon. A combination of descriptions will accordingly be innumerable for a certain total floor resiction force. 

^5 The Innumerable number of combinations of descriptions will surely include the combination of descriptions Indicating 
that the moment components other than that about the vertical axis are zero and the point of action is on the floor. The 
point of action in this combination of descriptions is called "total floor reaction force central point". 
[0084] A desired value of the total fioor reaction force is called "desired total floor reaction force". The desired total 
floor reaction force is the total floor reaction force which nonnally balances dyncunically with the desired motion patterri.: 

30 Accordingly, the desired total floor reaction force central point is nonnaily equal to the desired ZMP. 

[0085] As mentioned above, the ZMP (Zero IVloment Point) is defined as follows. Namely, obtaining the resultant 
force of the force of inertia and the gravity generated by the desired motion pattem, if the moment, except for the 
vertical moment component, of the obtained resultant force about a certain point of action on the fioor is zero, this point 
of action Is called "desired ZMP (Zero Moment Point)". The desired ZMP can solely be determined unless the vertical 

39 force component of the resultant force Is zero. The phrase "desired ZMP" is often used in this specification for ease 
of understanding. However, strictly speaking, the term "desired total floor reaction force central point" should Instead 
be used. 

[0086] A desired value of the foot floor reaction force is called "desired foot floor reaction force". Different from the 
desired total floor reaction force, the desired foot fioor reaction force can not be determined solely even when the 
<o desired motion pattern has been determined. Total floor reaction force actually acting on the rotx)t is called "actual total 
floor reaction force". Floor reaction force actually acting on each foot of the robot is called "actual foot fioor reaction 
force". 

[0087] Again refen^ing to the problems of the present invention, the two-leg-compilanca control can not cope with an 
unexpected local slant or level difference existing at a position at which the robot foot will land, but this problem can 
45 besoh^ if the ankle-compliance control is used. However, If the two-leg-compliance control and the ankle-compliance 
control are simply combined together to be used, the hwo kinds of control interfere with each other and this causes 
either one or both of the total floor reaction force and the foot floor reaction force to deviate from desirable values or 
causes control to oscillate. 

[0088] Again explaining this problem with reference to Figure 41 , the 1st foot heel is subject to an unexpected ex- 
80 cessive floor reaction force, which generates the actual excessive moment of foot floor reaction force about the 1 st 
ankle. The ankle-compliance control acts to rotate the Ist arikle so as to decrease this moment to zero, as shown In 
Figure 44. 

[0089] However, since the 1st foot heel position becomes high due to the ankle rotation, the vertical component of 
the 1st foot fioor reaction force decreases. As a result, the actual total fk>or reactbn force's moment about the desired 
59 total fioor reaction force central point (desired ZMP) fluctuates. This Indicates that actual total fioor reaction force's 
moment (which Is the controlled variable in the two-leg-compllance control) is Interfered by the ankle-compliance con- 
trol. 

[0090] If the two-leg compliance control were immediately conducted, without paying attention to the Interference, 
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the actual total floor reaction force's moment about the desired total floor reaction force central point (desired ZMP) 
would deviate from zero, or vibration or oscillation would occur due to the interference. 

[0091] One solution of this problem will be to detennlne the amount of Interference between the two-leg-compliance 

control and the anide-compllance control, and to input a manipulated variable to cancel the amount of Interference 

such that no interference occurs. Since, however, the robot posture changes at every instant and hence, the relationship 

of Interference changes at every Instant. It is quite difficult to avoid the Interference with this method. 

[0092] Moreover, since the floor at which the 1st foot lands Is at a greater slant than that anticipated In the desired 

gait in-the situation Illustrated in Figure 44, the let foot should have been controlled to lift its toe higher than the position 

anticipated In the desired gait It could be therefore said that the fact that the toe is driven to a lower position by the 

anMe-compllance control Indicates that the anlcle-compllance control does not operate appropriately. 

[0093] TTius, the anlde-compllance control is effealve for a local slant or level difference existing at a position at 

which the robot foot will land, but may affect the control on the floor having a slant or undulation extending over a 

relatively long distance. 

19094] in view of this problem, the system In the embodiment is configured such that the floor reaction force actbig 
on the legged mobile robot, more spedficaiiy, the actual total floor reaction force's moment about the desired total floor 
reaction force central point and actual foot floor reaction force's moment about the desired foot floor reaction force 
central point are controlled easily and appropriately. 

P)095] iWoneover, the system is configured such that, even If the floor has not only an unexpected slant or undulation 
extending over a relatively long distance, but also on an unexpected local slant or level difference, the robot locomotion 
can be continued with stable posture, without being affected thereby. 

[0090] in onder to solve the aforesaid problems, the applicant proposed a control system of a legged mobile robot 
before. The object of the present invention is to further improve the proposed technique and to provide a control system 
of a legged mobile robot in which a compliance control is conducted on the force component of the actual total floor 
reaction force acting on the robot, specifically on the vertical force component Fz such that the foot>landing Impact is 
absortaed and the contactability of the rot>ot foot with the floor Is enhanced. 

10097] Rgure 4 Is a blocic diagram showing the configuration and operation of the control system {mainly correspond- 
ing to the first calculator 80 in Rgure 3) of a legged mobile robot according to this embodiment in a functional manner. 
The overall configuration of the system will be explained with reference to Figure 4. 

[0098] The system includes a gait generator which generates the desired gait and outputs the same. As will be 
understood from the definition mentioned above, the desired gait comprises the desired motion pattern and the desired 
floor reaction force pattem, more specifically, a desired body position and/or posture trajectory, a desired feet position 
and/or posture trajectory, a desired total floor reacUon force central point (desired 2IVIP) trajectory and a desired total 
floor reaction force trajectory. Thus, the desired floor reaction force pattem includes the desired total floor reaction 
force central point trajectory. (It surK^es if the desired floor reaction force pattem merely has the desired total floor 
reaction force central point trajectory, when a deforni compensation (mechanism-deform compensation), explained 
later, is not invohfed.) 

[0099] in this embodiment, the desired total floor reaction force outputted by the gait generator is the total floor 
reaction force which dynamically balances with the desired motion pattem. Accordingly, the desired total floor reaction 
force central point Is equal to the desired ZMR 

[0100] Rgure 5 shows one example of motion pattem when the robot 1 wallcs on a flat floor. Figure 6 shows the 
trajectory of the desired ZMP on the floor corresponding thereto, and Figure /shows a tine chart corresponding thereto. 
The foot which is Icept contact with the floor during the Illustrated gait period is to be named the 1 st foot, while the other 
is to be named the 2nd foot. Since the gait generator is described In detaH In the application (Japanese Patent Appli- 
cation Hei 6 (1 996) -21 4. 261 ). further explanation will be omitted. 

(01011 Ftetuming to the explanation of Figure 4. the system Includes a desired floor reaction force distributor which 
receives the desired total floor reaction force central point (desired ZMP) and the desired feet position and/or posture 
as main inputs, and detemilnes and outputs the desired foot floor reaction forx:e central point of each foot. Practically, 
if required, It may also Input gait parameters (such as the time of two-leg supporting period and desired landing position 
of free leg foot) or the period and time of gait (such as the cument time is O.lsec. after the beginning of the two-teg 
supporting period) from the gait generator. 

[0102] As regards the gait such as illustrated in Figure 5. the desired floor reaction force distributor detemilnes the 

desired foot floor reaction force central point such that It satisfies the following conditions. 

[0103] Condition 1) The desired foot floor reaction force central point trajectory is continuous. 

[01 04] Condition 2) During the two-leg supporting period, the desired 1 st foot floor reaction force central point exists 

at its heel, while the desired 2nd foot floor reaction force central point exists at its toe. 

[01 05] Condition 3) The desired total floor reaction force central point exists, at that instant, on the segment between 
the desired 1 st foot floor reaction force central point and the desired 2nd foot floor reaction force central point 
[0106] Condition 4) During the one-leg supporting period, the desired 1st foot floor reaction force central point Is 
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equal to the desired total floor reaction force central point 

[Ql 07] Condition 6) During the one-leg supporting period, the desired 2nd foot floor reaction force central point shifts 
from the toe to the heel. 

[0108] Figure 8 shows the time chart of the desired 1st foot floor reaction force central point trajectory satisfying 
these conditions, while Rgure 9 shows that of the 2nd foot floor reaction force central point tralectory. In the figures, 
the origin is defined as the point on a sole of foot projected from the ankle Goints 1 8R(L), 20R(L)) onto the sole of the 
foot 22R(L) at the angle perpendicular to the plane defined by the sole of foot, while the positive direction on the 
axis Is defined as the direction from the origin towards the front of the foot and along the plane defined by the foot, and 
the posith^e direction on the Y-axIs Is defined as the direction to the left of the foot from the origin as shown In Rgure 1 . 
(0109] Additionally, the desired floor reaction force distributor detennlnes and outputs the desired fool floor reaction 
force of each foot. The desired foot floor reaction force is necessary for the deform compensation (mechanism-deform 
compensation) of the spring mechanism 32, etc. 

[01 1 0] If the desired foot floor reaction force Is determined to be corresponding to the desired foot floor reaction force 
central point, determined in the manner mentioned above, using the following equation, it will satisfy a condition that 
the resultant force of all of the desired foot floor reaction forces must be equal to the desired total floor reaction force. 
[0111] Desired 1 st foot floor reaction force = Desired total floor reaction force * (Distance between the desired 2nd 
foot floor reaction force central point and the desired ZMP) / (Distance between the desired 1st foot floor reaction force 
central point and the desired 2nd foot floor reaction force central point) 



Desired 2nd foot floor reaction force « Desired total floor reaction force * 
(Distance between the desired 1st foot floor reaction force central point and the desired 
ZMP) / (Distance between the desired 1 st foot floor reaction force central point and the 

desired 2nd foot floor reaction force central point) ' Eq. 1 

[0112] Since the desired foot floor reaction force changes continuously, It Is suitable for achieving walking with less 
foot-landing impact. The details of the above Is described in an application (Japanese l^id-Open Patent Application 
Hel 8 (1 994) - 79,657) proposed by the applicant. 

[01 13] Returning to the explanation of Figure 4, the system includes a posture stabilization controller which estimates 
the conditions of the robot based on the sensed Infomnation of the robot and calculates a compensating total ifioor 
reaction force. Explaining this, assuming that robot joint displacement Is controlled to track desired Joint displacement 
completely through a displacement controller (explained later) while the robot walks or is upright, the robot positton 
and/or posture will not always be a desirable value. 

[0114] in order to stabilize the robot posture over a long period, it Is necessary to determine the force and moment 
necessary to restore deslrabie robot position and/or posture, and to additionally generate the determined force and 
moment at the desired total floor reaction force central point (desired ZMP) as the point of action. The addltlorial force 
and moment Is called "compensating total floor reaction force". The moment component of the compensating total floor 

reaction force is called "conrpensating total floor reaction force's moment". „ ... 

[01 15] Aside from the above, assuming that the desired gait of the legged mobile robot is subject to a reaction force, 
other than the floor reaction force, from the environment, naming this reaction force "reaction force from object", for 
example, the aforesaid definition of the desired ZMP may be extended as follows. That Is; obtaining the resultant force 
of the force of Inertia, the gravity and the reaction force from object generated by the desired motion pattern, If the 
moment, except for the vertical component, of the obtained resultant force about a certain point of action on the floor 
Is zero, the point of actton Is newly defined as "desired ZMP". 

[0116] Assuming that the rot>ot 1 1s completely rigid and joint displacement can be controlled to track desired joint 
displacement faithfully, perturbatlve motion of the position and/or posture of the entire robot due to defomnatlon of the 
spring mechanism 32 and the sole elastic member 34 of the foot can be decomposed to the following six degrees of 
freedom. 

[0117] Mode 1) Rotation about the desired total floor reaction force central point (desired ZMP) around the back- 
and-forth*axis (I.e., tilting In the left-and-rfght direction). 

[0118] Mode 2) Rotatton about the desired total floor reaction force central point (desired ZMP) around the ieft-and- 
right-axls (I.e., tilting In the back-and-forth direction). 

[01 1 9] Mode 3) Vertical rotation about the desired total floor reaction force central point (desired ZM P) (i.e., spinning). 
[0120] Mode 4) Parallel-translation al swinging in the back-and-forth direction. 
[0121] Mode 5) Parailel-translatlonai swinging In the left-and-right direction. 
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[01 22] Mode 6) Parallei-transtatlonal swinging In the vertical direction. 

P>1 23] Among these modes, the swings of Mode 4 and Mode 6 occur wfth the del omiation of the spring mechanism 
32 and the sole elastic member 34 of the foot when they are subject to shearing force In the back-and-f orth and left- 
and-right directions. Since the spring mechanism 32 and the sole elastic member 34 are prefabricated to have high 
9 stiffness In the direction of shearing, this kind of swing Is small, affecting the walking only slightly. 

[0124] In the technique proposed earlier, Mode 1 and Mode 2 were discussed. In the embodiment according to the 
present invention, In addition thereto, Mode 6 Is discussed. For ease of understanding, the technique proposed earlier 
will first be mentioned, although the explanation will be redundant. 

[0125] The manipulated variable for controlling the rotation of mode 1 Is the moment component about the back- 
and-forth axis (X-axis) of the compensating total floor reaction force. The manipulated varlableforcontrolling the rotation 
of mode 2 Is the moment component about the left-and-right axis (Y-axIs) of the compensating total floor reaction force. 
Among the moment components of the compensating total floor reaction force, accordingly, it suffices If the moment 
component about the back-and-f orth axis and that about the left-and-right axis are detemiined. Since the rest of the 
moment components are not used in this embodiment, they may be set to zero. 

[01 26] From now on the following definitions will apply. The moment component of compensating total fk>or reactton 
force is called "compensating total floor reaction force's moment Mdmd" (more precisely, compensating total fk>or 
reactton force's moment Mdmd about the desired total floor reaction force central point (desired ZMP)). As illustrated 
in Figure 6, a coordinate system taking the X-axis in the robot fonwarding direction, the Y-axis in the robot left directton 
and the Z-axis In the vertical direction and having the origin whtoh is set at a point on the floor immediately below the 
^ 1st foot ankle, Is called "supporting-leg coordinates system". Unless otherwise detemiined, the position, the force and 
the moment are expressed in accordance with this coordinate system. The X-component of Mdmd is named Mdmdx, 
Y-component thereof is named Mcfrndy and Z-component thereof is Mdmdz. The X-component of an inclination enror 
6 en- of the body 24 (i.e., actual body inclination - desired body inclination) is named e enx, Y-component thereof is 
named 6 erry, and their time differentials are named (de enx/dt), (de erry/dt). 

[01 27] Mdmdx and Mdmdy are determined \n accordance with, for example, the following control laws. 

Mdmdx ^ • Kthx e enrx - Kwx(dderrx/dt) 
3Q Mdmdy «-KthyOenry-Kwy(deeny/dt) Eq.2 

[01 28] In the above, Kthx, Kthy, Kwx and Kwy are control gains for body inclination stabilization. 
[01 29] The composite compliance operation detenninator acts such that the actual total floor reaction force k>ecomes 
equal to the resultant force of the desired total floor reactbn force and the compensating total floor reac^on force, as 
39 will be explained later 

[01 30] Returning to the explanation of Rgure 4. the system includes an actual foot floor reaction force detector whteh 
detects the actual foot floor reaction force through the output of the force sensor 44. (The resultant force of all of the 
foot floor reaction forces Is the actual total floor reaction force.) Moreover, based on the actual joint displacements 
obtained from the Joint encoders (or based on the Joint displacement commands), the actual foot floor reaction forv:e 
49 detector calculates each foot position and/or posture relative to the coordinate system fixed on the body, then conduct 
coordinate-transfomiatlon of the detected values obtained by the force sensor 44 to calculate the actual foot floor 
reaction force In the coordinate system fixed on the body, and converts the caiculaled values into those In the supporting 
leg coordinate system. 

[0131] The system Includes a robot geometric nru)del (inverse kinematic solution), which, upon receipt of the body 
45 position and^or posture and the feet position and/or posture, calculates respective Joint displacements satisfying them. 
Sbice the degrees of freedom per leg is 6 In the robot 1 In this embodiment, the respective Joint displacements are 
determined solely. 

[0132] This emfc>odlment Is configured such that, equations of the inverse kinematic solution are directly prepared 
beforehand in such a manner that the respective Joint displacements are obtained if the body position and/or posture 

so and the foot position and/or posture are put in the equations. More speciflcally, the robot geometric model inputs the 
desired body position and/or posture and a corrected desired foot position and/or posture trajectory (a corrected desired 
feet position/posture with deform compensation) corrected by the composite compliance operation determlnator, and 
calculates Joint displacement commands for the 12 Joints (including 10R(L), etc.). It should be noted that the Joint 
displacement command may alternatively be determined using Jacobian. 

^ [0133] The system includes a displacement controller (corresponding to the aforesaid 2nd calculator 82), which 
controls displacements of the 1 2 Joints of the robot 1 to track the Joint displacement conrwnands calculated by the robot 
geometric model (inverse kinematk) solution). 

[01 34] The aforesaid composite compliance operation detenninator which corrects the desired foot position and/or 
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posture trajectory to satisfy the following two dernands. 

[0136] Demand 1) For the control of robot position and/or posture, the actual total floor reaction force should be 
controlled to track the resultant force of the compensating total floor reaction force (moment Mdmd) outputted by the 
posture stabilization controller and the desired total floor reaction force, if only the robot posture inclination should be 

9 controlled* only the horizontal direction moment component of the actual total floor reaction force about the desired 
total floor reaction force central point should be controlled to track the oompensatino total floor reaction force's moment 
Mdmd. 

[0136] Demand 2) In order to ensure the fioor-contactablllty of each foot, the absolute value of the actual foot floor 
reaction force's moment at>out the desired foot floor reaction force central point should be as small as possible. 

10 [01 37] incidentally, normally in most situations, it Is physically impossible to make each of the actual moment of foot 
floor reaction force about the desired foot floor reaction force central point to be zero, while causing the actual total 
floor reaction force to be equal to the resultant force of the compensating total floor reaction force and the desired total 
floor reaction force, it will accordingly be difficult to completely satisfy both Demand 1) and Demand 2). and some 
compromise should therefore be needed. 

f 9 [01 36] Based on the above, the operation of the system will be explained with reference to the f tow chart (structur- 
allzed ftow chart) of Rgure 10. The left of the flow chart indicates the elements Illustrated in Figure 4 which conduct 
the procedures corresponding to those mentioned in the right steps of the flow chart. 

[0139] The program begins In S10 in whteh the system Is initialized and proceeds, via SI 2, to SI 4 in which timer 
intenxipt Is waited for. The timer interrupt Is executed once every 50msec. Thus, the control cycle is 50msec. 

so [01 40] The program proceeds to 816 in which it is determined whether it is at gait switching, more specifically. It is 
determined whether it is at switching of the supporting leg. If the result Is negative, the program proceeds to S22. If 
the result Is affirmative, the program proceeds to 818 in whteh a timer t is initialized, and to 820 in which the desired 
gait parameters are set As mentioned above, the gait parameters comprise the motion parameters and the floor re- 
action force parameters (I.e., the IMP tr^ectory parameters). 

^9 [0141] The program proceeds to 822 In which instantaneous values of the desired gait is determined. Here, the 
"Instantaneous value" indicates values at each control cycle. The Instantaneous values of the desired gait comprise 
the desired body position and/or posture, the desired foot position and/or posture, and the desired ZMP position. Here, 
the "posture" indicates "orientation or direction" in the X. Y, Z space or environment. 

[0142] The program then proceeds to 824 In which the desired foot floor reaction force central point is determined. 
30 This Is done in the manner explained with respect to the desired floor reaction force distributor. Specifically, this is done 
by determining the value of the set desired foot ftoor reaction force central point trajectory at the current tinne t, as 
illustrated in Figures 6 and 9. 

[01 43] The program then proceeds to 826 in whk;h the desired foot floor reaction force of each foot is determined. ; ^ ^ 

This Is done by calculating the desired foot f k>or reaction force using Eq . 1 mentk^ned in the explanation of the desired 

39 floor reaction force distributor. 

[01 44] The program then proceeds to 828 In whk:h the conditions of the robot such as the Inclination of the body 24 .i> 
are detected using the outputs of the sensors including the inclination sensor 60. At this time, actual accelerations in .'^ 
the direction of the X-axis. Y-axis and Z-axis acting on the body 24 are also detected. In order to solve the aforesaid 
problems, this embodiment Is explained with reference to the body acceleration in the direction of the Z-axis (vertical 

40 direction; hereinafter referred to as "Gbodyz*) In the following. However, the following explanation will also be applied 
to those In the directions of X-axis and Y-axis. - ..... 

[0145] Tho program then proceeds to 830 in which the compensating total floor reaction force's moment Mdmdx, 
Mdmdy (about the desired total fk)or reaction force central point (desired ZMP)) for posture stabilization are determined 
based on the detected condittons, etc. More specifically, the compensating total floor reaction force's moment Mdmdx, 
4^ Mdmdy are detannlned In accordance with Eq. 2 in order to effect posture stabilization when the body inclination is 
detected. 

[0146] The program then proceeds to S31 In which the force component of the compensating total floor reaction 
force is calculated based on the Z-dlrectlon body acceleration control law. This will be explained later. 
[01 47] The program then proceeds to 832 In whteh the actual foot floor reactk>n force Is detected for each foot. This 
so Is done from the output of the force sensor 44, as mentioned above. 

[01 43] The program then proceeds to 834 In which a feet compensating angle edbv and a foot compensating angle 
enx(y) for each foot are determined. This procedure Is done by the aforesaid composite compliance operatk)n deter- 
mlnator. 

[01 49] The procedures to be done by the composite compliance operation detemnlnator will be explained. For ease 
99 of explanation, it Is within the two-leg supporting period In which the actual foot floor reaction force is respectively acting 
on the 1 St foot 22R(L) and the 2nd foot 22L(R), as illustrated In Figure 11 . 

[0160] Here, a vector Fnact Indicates the force component of the n-th foot floor reaction force, and a vector Mnact 
indicates the moment component of the n-th foot floor reaction force. The direction of vector Mnact indicates that the 
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moment acts from the floor to the foot dockwiee with respect to the vector direction. 

(01 61 ] The desired total floor reaction force at this instant are assumed to be as shown In Figure 1 2. Notably, a vector 
Msumref indicative of the desired total floor reaction force's moment about the desired total floor reaction force central 
point (desired ZMP) Is vertical. (This is because the desired ZMP Is a floor point at which the horizontal component of 

^ desired total floor reaction force's moment Is zero in accordance with the definition mentioned above.) 

10152] When the desired total floor reaction force Is distrbuted to or dhdded into the respective desired foot floor 
reaction forces in accordance with Eq. 1 , the result will be that as shown in Figure 13. In the figure, a vector Fnref 
indicates the force component of the desired n-th foot floor reaction force. A vector Mnref indicates the moment com- 
ponent of desired n-th foot floor reaction force. The description of the direction of vector Mnref is the same as that of 

10 Mnact. 

[0153] For ease of explanation, It Is assumed that the robot Is at>out to turn over backward to the left. 
[01 54] The aforesaid posture stabilization controller calculates the compensating total floor reaction force's moment 
Mdmd based on the detected body Inclination errors 6errx. eeny of the robot 1. In this embodiment, since the spinning 
about tiie vertical axle (Z-axis) is not controlled, the vertical component of the compensating total floor reaction force's 
19 nrioment l^ldrnd' Is zero. Figure 14 shows the compensating total f k>or reaction force's moment Mdmd for the assumed 
condition. 

[01 55] In order to restore the posture, it suffices if the horizontal component of the actual total floor reaction force's 
moment about the desired total floor reaction force central point (desired ZMP) is controlled to track a horizontal comv 
ponent of a sum of the desired total floor reactton force's moment Msumref and the compensating total floor reactton 
force's moment Mdmd. 

[0156] The horizontal conrponent of desired total floor reaction force's moment Msumref Is zero at the desired total 
floor reaction force central point (desired ZMP). Accordingly. In order to restore the posture inclination in the back-and- 
force or left-and-right direction, it suffices If the horizontal component of the actual total floor reaction force's moment 
about the desired ZMP is controlled to track tfie horizontal conrponent of Mdmd. 
^9 [0157] In this embodiment, the composite compliance operation detemilnator corrects the feet position and posture 
so as to satisfy the aforesaid following demands as much as possible. 

[0158] Demand 1) In order to stabillzatk>n-control the robot posture inclination, the horizontal components (X-axis 
and Y-axis) of the actual total floor reaction force's moment about the desired total fk)or reaction force central point 
(desired ZMP) shoukt be controlled to track the horizontal components of the compensating total floor reaction forced 
3o moment Mdmd. 

[0159] Deniand 2) In order to ensure the floor-contactability of each foot, the absolute value of the actual foot floor 
reactk>n force's moment about the desired foot floor reaction force central point shouM be as small as possible. 
[01 60] As mentioned above, it is Impossible to satisfy both Demand 1 ) and Demand 2) and hence, some compromise 
Is needed. 

39 [01 61] In tiiis embodiment, the connection of feet position and^or posture is conducted as follows. 

[01 62] 1 ) A vector V which is normal on the plane tiiat Includes the desired 1 st foot floor reaction force central point 
Q1 and the 2nd foot floor reaction force central point Q2 and that is perpendteular to the horizontal plane, is first 
determined. The magnitude of V should be 1 . Figure 15 shows the vector V. 

[01 63] 2) The coordinate of the desired 1 st foot floor reaction force central point Q 1 is rotated (moved) by a rotational 
<o angle edbv about the desired total floor reactton force central point (desired ZMP) around the nomial vector V. The 
central poirit after rotation is called Q1'. Similarly, the coordinate of the desired 2nd foot floor neactlbn force central 
point Q2 Is rotated (moved) by tfie same rotational angle 0 dbv about tiie desired total floor reaction force central point 
(desired ZMP) around the nonmal vector V. The central point after rotation called Q2'. 

[01 64] This rotational angle Odbv is called "feet compensating angle". The vector whose initial point Is Q 1 and whose 
<s temrtinal point is QV, Is named a vector Q1 Q1'. Similarly, a vector whose Initial point is Q2 and whose terminal point 
is Q2', is named a vector Q2Q2'. Rgure 1 6 shows Q1 ' and Q2'. 

[01 65] 3) Then , the desired 1 st foot Is parallel-translated (moved up and down) by the vector Q1 Q 1 ', without changing 
Its posture. SImilariy, the desired 2nd foot is parailel-translated by tiie vector 0202*, without changing Its posture. 
Figure 1 6 shows each desired foot after movement with thicic lines. 

sa [0166] 4) Then, tiie desired 1st foot is rotated about Q1 ', by a rotational angle Six around the baclc-and-forth axis (X- 
axls) and by a rotational angle 61 y around tiie left-and-right axis (Y-axis) . Similarly, the desired 2nd foot is rotated about 
02*, by a rotational angle e2x around the back-and-fortti axis (X-axIs) and by a rotational angle e2y around tiie left- 
and-rlght axis (Y-axIs). The rotational angles enx and any are called "n-th foot X-compensating angle" and "n-th foot 
Y-compensating angle", respectively. Figure 17 shows each desired foot after rotation with thick lines. 

ff* [01 67] If the above amount of conpensatlng operation Is not excessive, tiie contact-area of foot sole (ttie foot sole 
area where the pressure is positive) remains unchanged, although the distribution of pressure of the foot sole may 
change. If this Is the case, tiie spring mechanism 32 and tiie sole elastic member 34 provMed at each foot deform by 
an amount proportionate to the amount of compensating operation and generate the actual foot floor reaction force at 
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each foot in response to the amount of defonDation. With this, the relationship between the amount of compensating 
operation and the change in the actual foot floor reaction force generated by the compensating operation will exhibit 
the following appropriate characteristics. 

[0168] Characteristic 1) If only the feet compensating angle 6 dbv is manipulated to move the desired feet position, 
9 the actual foot floor reaction force's force component of the foot which is moved down, Increases, white that of the foot 
which is moved up decreases. At this time, the actual foot floor reaction force's moment about the corrected deelred 
foot floor reaction force central point changes little. 

[01 69] Characteristic 2) If only the n-th foot X-compensating angle Is manipulated to rotate the n4h foot posture, only 
the X-component of the actual n-th foot floor reaction force's moment about the desired n-th foot floor reaction force 
central point changes, but the other floor reaction force components change slightly. Sfmiiariy, if only the n-th foot Y- 
compensating angle Is manipulated to rotate the n-th foot posture, only the Y-component of the actual n-th foot floor 
reaction force's moment about the desired n-th foot floor reaction force central point changes, but the other floor reaction 
force components change slightly. 

[0170] Characteristic 3) When the feet compensating angle e dbv, the foot X-compensating angle and the foot Y- 
f 9 compensating angle are all manipulated at the same time, the change amount of actual foot floor reaction force will be 
the sum of the individual change amounts obtained by respective manipulation. 

[9171] It could be stated from the above that characteristics 1) and 2) indicate that the respective man^iulations 
mentioned there have independency, while characteristic 3) indicates that the respective manipulations have linearity. 
[0172] Rgure 16 Is a block diagram showing the calculation of the composite compliance operation detemninator. 

^ The calculation will be explained with reference to the figure. 

[01 73] Briefly explaining, a total floor reaction force compensating moment distrtoutor distributes or divides the com- 
pensating total floor reaction force's moment Mdmd. Then, a feet compensating angle detemiinator and a n-th foot X- 
compensatlng determinator as well as a n-th foot Y-compensating angle determinator determine the aforesaid com- 
pensating angle 9dbv and Onx (y) based on the actual foot floor reaction force and the distributed compensating total 

^5 floor reaction force's moment, etc. 

[0174] Then, a corrected feet position/posture calculator determines a compensated feet position and/or posture 
(named as "corrected desired feet position and/or posture") through a geometric calculation based on these detemriined 
compensating angles. Finally, a connected desired feet position and/or posture with deform compensation calculator 
determines the amount of defonnation of the spring mechanism 32 and the sole elastic member 34 expected to be 

30 generated by the desired foot floor reaction force, and further corrects the corrected desired feet position and/'or posture 
to cancel the same. 

[0175] To be more specific, the total floor reaction force compensating moment distributor distributes the compen- 
sating total floor reaction force's moment Mdmd to (divides into) a feet compensating moment Mdmddb and foot com- 
pensating moments iy4dmd1x, y, Mdmd2x, y. The feet compensating moment i^dmddb is a desired value of moment 
39 to be generated about the desired total floor reaction force central point (desired ZMP) by tiie force component of the 
foot floor reaction force through the manipulation of the feet compensating angle (tiie amount of feet up-and-down 
movement) edbv. 

[0176] The component around the V-directlon of the feet compensating moment f^dmddb Is expressed as Mdmddbv. 
The V-dlrection Is the direction of vector V defined with reference to the explanation of tiie composite compliance 
49 operation detemninator. Defining a vector which is perpendicular to V and the vertical direction as "U", a U-component 
Mdmddbu of the.feet compensating moment Mdmddb is set to zero. This is because the manipulation of feet compen- 
sating angle 6 dbv can not generate the U-dlrection moment of floor reaction force. 

[0177] In this emt>odiment, since the vertical component of the compensating total floor reaction force's moment 

Mdmd is zero, the vertical component Mdmddbz of Mdmddb is also set to zero. 
4' [0178] The Ist foot compensating moment Mdnndi is a moment to be generated about the desired 1st foot floor 

reaction force central point by manipulating the 1st foot compensating angles Blx and eiy The X-component of 1st 

foot compensating moment Mdmdl is expressed as Mdmdl x, while the Y-component thereof Is expressed as Mdmdiy. 

The 2nd foot compensating moment Mdmd2 is a moment to be generated about the desired 2nd foot floor reaction 

force central point by manipulating the 2nd foot compensating angles 6 2x and e2y. The X-component of 2nd foot 
so compensating moment Mdmd2 is expressed as Mdmd2x, while the Y-component thereof is expressed as Mdmd2y 

[0179] The distribution will be carried out, for example, In the manner mentioned below. 



Mdmddbv = Wdbx * Mdmdx + Wdby * Mdmdy 



Eq.3 



85 



Mdmdix =: Wlx * (Mdmdx - Wint * Vx * Mdmddbv) 
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Mdmdly = W1y * (Mdmdy - WInt ♦ Vy * Mdmddbv) 
Mdmd2x = W2x * (Mdmdx - Wint ♦ Vic * Mdmddbv) 
* Mdmd2y = VV2y '{Mdmdy- WInt *Vy*MdrndcBw) Eq.4 

[0180] In the above, Wdbx, Wdby, Wlx, Wly. W2x, W2y and WInt are distribution-weight variables. Vx is a value of 
the X-component of vector V and Vy is that of Y-component of vector V Among the variables, Wint is a variable for 
10 canceling the total floor reaction force's moment (generated due to the manipulation of the feet compensating angle) 
by manipulating the foot compensating angles. 

[0181] Rgure 19 is a biock diagram showing the total floor reaction force compensating moment distributor which 
conducts the calculation of Eqs. 3 and 4. 

[0182] Rgure 20 ehowe an example of the distribution^eight variables Wdbx, Wdby, Wlx, Wly, W2x, W2y and 
19 Wint, during robot walking. The patterns Illustrated In Figure 20 should preferably be set taking the following attentions 
into account. 

[01 83] Attention 1 ) If the feet compensating angle and the foot compensating angle vary discontinuously. the Joints 
experience an excessh^e torque, in order to change the feet compensating angle and the foot compensating angle 
continuously, the distrt>ution-weight variables should be changed continuously. 
^ [01 84] Attention 2) The distrbution-weight variables should be determined such that the actual floor reaction forced 
moment generated by the manipuiatk>n of the feet compensating angle and the foot compensating angle, is as dose 
as possible to the compensating total floor reactton force's moment Mdmd. 

[01 85] IMoreover, the variables should preferably be set in response to the situation of robot such as being upright, 
walking, etc. in a situation such as being upright in which the V<llrectk>n-component Mdmddbv of the feet compensating 
^5 moment and the foot compensating moment Mdmdl , Mdmd2 can be faithfully generated in the actual foot floor reaction 
force, the variable should preferEdsly be set as follows. 

[0186] Spedfbaltyi In this situation, the variables should be set, satisfying both Eqs. 5 and 6 as much as possible, 
such that the horizontal component of the adual total floor reaction force's moment about the desired total floor reaction 
force central point becomes equal to the horizontal component of the compensating total floor reaction force's moment 
30 Mdmd (in other words, Demand 1 ) must be satisned with respect to the composite compliance operatton detenninator). 

Mdmddbv * Vx -h Mdmdl x + Mdmd2x » Mdmdx Eq. 5 



39 
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45 



Mdmddbv * Vy Mdmdl y + Mdmd2y = Mdmdy Eq. 6 

[01 87] Substituting Eqs. 5 and 6 Into Eqs. 3 and 4 respectively, Eq. 5 is written as Eq. 7, while Eq. 6 Is written as Eq. 8. 

(Wdbx * Mdmdx + Wdby • Mdmdy) * Vx + W1 x-' (Mdmdx - Wint * „ ^ 
Vx • (Wdbx ♦ Mdmdx + Wdby * Mcbndy)) + W2x * (Mdmdx - Wint * Vx * (Wdbx * 

Mdmdx 4. Wdby * Mdmdy)) = Mdmdx Eq. 7 



(Wdbx • Mdmdx + Wdby • Mdmdy) • vy + Wly • (Mdmdy - Wint ' 
^ Vy * (Wdbx * Mdmdx + Wdby * Mdmdy)) + W2y * (Mdmdy - Wint * Vy * (Wdbx * 

Mdmdx -I- Wdby * Mdmdy)) = Mdmdy Eq. 8 

[0188] In order to always satisfy Eqs. 7 and 8. no matter what values Mdmdx and Mdmdy are, it sufftees if Eqs. 9, 
35 10 and 1 1 are satisfied at the same time. 

Wint^^l Eq. 9 
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W1x + W2x = 1 



Eq. 10 



5 



W1y + W2y = 1 



Eq. 11 



[01 89] In the situation mentioned above, thus, it suffices if the variables are determined to satisfy Eqs. 9,10 and 1 1 
at the same time. 

[01 90] When the robot Is walldng, the generated actual total floor reaction force's moment may sometimes be smaller 
10 than Mdmddbv. even if the foot position is conrected by manipulating the feetcompensating angle Odbv so as to generate 
Mdmddbv. As shown in Figure 21, for example, assuming that the robot titts backward such that the 1st foot has not 
landed at the beginning of the two-leg supporting period, the actual floor reaction force does not change even if the 
1st foot position is moved down by 9 dbv. 

[01 91 ] Similariy, the increase of actual floor reaction force's moment may sometimes be smaller than Mdmd2, even 
f5 If the angle of the 2nd foot is corrected by manipulating the 2nd foot compensating angle 92 so as to generate Mdmd2. 
As shown In Figure 22, for example, assuming that the robot tilts backward at the latter half of the two-leg supporting 
period, the actual floor reaction force does not change even if the 2nd foot heel is moved down. 
[0192] Thus, even when the variables are determined to satisfy Eqs. 5 and 6, the Increase of the actual floor reaction 
force generated tiy the connposite compliance control nnay sometimes be less than the compensating total floor reaction 
^ force's moment Mtknd. The values obtained by dividing the left sides of Eqs. 5 and 6 by their respective right sides 
should accordingly be set to be greater than 1 under the situation where this problem would be likely to occur 
[01 93] In Figure 20 showing an example of setting of the distribution -weight variables during walking, Wint Is set to 
zero such that the manipulation of foot compensating angle can make up for the \acK even when the manipulation of 
the feet compensating angle 6dbv can not generate the actual total floor reaction force's moment in the situatton such 
2s as illustrated in Rgure 21 . 

[0194] Advantageously, if the robot tilts backward as illustrated in Figure 21, since the 2nd foot heel moves down 
effectively to be easily landed on the floor, the actual total fk^or reaction forces's moment can easily be generated by 
manipulating the 2nd foot compensating angle. 

[0195] If the robot is not tilting backward, the actual total floor reaction force's moment is generated due to the ma- 
30 nipulation of the feet compensating angle 9 dbv, but the 2nd foot heet has not landed on the floor, the manipulation of 
2nd foot compensating angle does not yield the actual total floor reaction force's moment. 

[0196] More specifically, the foot compensating angle does not ac^ effectively when the feet compensating angle 
9dbv acts effectiveiy, while the feet compensating angle Odbv does not act effectively when the foot compensating 
angle acts effectively. The sum of the respective actual total floor reaction force's moment generated by mcmipulating 

39 the feet compensating angle and the foot compensating angle becomes, as a result, almost equal to the compensating 
total floor reactk>n force's nrrament Mdmd. 

[01 97] Depending on the situation, the sum of the respective actual total floor reaction force's moment generated by 
manipulating the feet compensating angle and the foot compensating angle nnay sometimes become greater than the 
compensating total floor reaction force's moment Mdmd. 

40 [01 98] Even if this happens, since Mdmd is a feedback manipulated variable for posture stabilization in this embod- 
iment, it will not be a serious problem, since, as will be generally experienced In every control system, the magnitude 
variance of Mdmd will cause the open-loop gain In the control system to vary slightly, but the closed-loop characteristics 
will have little change. 

[01 99] Attention 3) The absolute values of the distribution-weight variables for feet compensating angle. Wdbx, Wdby, 
45 should be small during the one-leg supporting period. This Is because changing the feet compensating angle during 
the one-leg supporting period will result in a wastiaful up-and-down movement of the foot out of the floor, but will result 
In no change In the ac^jai foot floor reaction force. 

[0200] Attention 4) If the force component of the desired foot floor reaction force Is small, the absolute value of the 
distribution -weight variable for the foot compensating angle of the foot concerned, should be small so as to ensure the 
so floor-contactability of the foot. In particular, if the foot is far from the floor, the absolute value of the distribution-weight 
variable should be small, since the movement of the foot by the foot compensating angle will not result in the change 
of the actual floor reaction force of that foot, so as to avoid a wasteful foot movement 

[0201] Attention 5) The direction of the actual total floor reactton force's moment which can be controlled by manip- 
ulating the feet compensating angle is ordinary differant from that which can be controlled by manipulating the foot 
89 compensating angle. 

[0202] For example, the direction of the actual total f k>or reaction force's moment generated by manipulating the feet 
compensating angle 9 dbv Is always the V-direction, and it can not generate any component perpendicular to the V- 
dlrection. On the contrary, the direction of the actual total floor reaction force's moment generated by manipulating the 
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foot compensating angle is restricted depending on the situation. 

]p2Q3] For exaniple, If the foot Is in contact with the floor only by the toe edge or heel edge, no moment can be 
generated In the direction of the edge line. During the two-leg supporting period, taking this characteristic Into account, 
the feet conrpensating angle and the foot compensating angle should accordingly be manipulated with a minimum loss. 
[0204] For example, the distribution-weight variables Wdbx, Wdby for manipulating the feet compensating angle 
should be determined as follows. 

[0205] Specifically, defining a vector whose X-component is Wdbx, whose Y-component is Wdby and whose Z-com- 
ponent is zero, as "Wdb". Eq. 3 is the Inner product of the vector Wdb and Mdmd. It could be said that what Is obtained 
by resolving Mdmd to the component of the direction of vector Wdb and the component perpendicular thereto and then 
10 by extracting the component of the direction of vector Wcto and then by multiplying by the magnitude of vector Wdb, 
Is Mdmddbv calculated in accordance with Eq. 3. 

[0206] Figure 23 shows this Mdmddbv. This indicates to build a feedbacic control system which controls the Wdb» 
direction component of the actual total floor reaction force's moment by manipulating the feet compensating angle. If 
the Wdb-directlon Is perpendicular to the vector V, the Wdb-direction component of the actual total floor reaction force's 
19 moment will not be generated no matlerto what extent the feet compensating angle Is manipulated, and the feedback 
control system wouki control the feet compensating angle in vain. 

[0207] In orderto decrease such a wasteful operation, the Wdb-dlrection should accordingly be equal to the directton 
of vector V or be ck>se thereto as much as possible. Moreover, when it Is intended that the Wdb-direction component 
of the compensating total floor reaction force's moment is generated, without using the foot compensating angle, but 
^ by solely manipulating the feet compensating angle, it should be detemilned such that the Inner product of Wdb and 
V is 1 . if it is Intended to generate a part of the component by the foot compensating angle, they shouW be detemilned 
such that the Inner product of Wdb and V is less than 1 . 

[0206] Aside from the above, when the lateral width of the foot is small, the X-component of the actual foot floor 
reactton force's moment generated by manipulating the foot compensating angle will be small, in this case, the mag- 
^5 nitude of Wdbx should preferably be set to be larger. With this, although the Wdb-direction and the directton of the 
vector V become not equal to each other and the fluctuation of the feet compensating angle Increases, the stability is 
enhanced. 

[0209] The feet compensating angle detemilnator wilt be explained further. Figure 24 Is a block diagram showfrig 
the calculation of the feet compensating angle detemnlnator. The feet compensating angle Odbv is cakulated in the 
30 manner as illustrated. 

[0210] Explaining this with reference to Figure 24, a moment Mf1f2act, which is generated about the desired total 
floor reaction force central point P by Ract acting on the desired 1 st foot floor reaction force central point Q1 and F2act 
acting on the desired 2nd foot floor reaction force central point Q2. is detennined in accordance with the following 
equation. 

39 

Mf1f2act = PQ1 • F1act + PQ2 * F2aca Eq. 12 

[0211] In the above. PQ1 is a vector whose Initial point is P and whose temiinai point is Q1 , while PQ2 ia a vector 
40 whose Initial point Is P and whose tenninal point Is Q2. 

[0212] Instead of Eq. 12, the following equation can be used without introducing any substantial problems. 

Mf1f2ect=PQ1 * F1act4-PQ2* F2act4-M1act4-M2act Eq. 12a 

49 

[0213] Eq. 12a is an equation which catoulates the actual total floor reaction force's moment Msumact acting about 
the desired total floor reaction force central point. Eq. 12 indicates the difference obtained by subtracting the actual 
foot floor reaction force's moment acting about the desired foot floor reaction force central point from the actual total 
floor reaction force's moment acting about the desired total floor reaction force central point. Claim 5 is based on this. 
5^ [0214] Next, the vector V-directlon-component Mf 1 f2actv of Mf 1f2act is extracted. This can be obtained in accordance 
with the following equation whteh uses the caiculatbn of vector Inner product. The vector V Is the vector Illustrated in 
Rgure 1 5 with reference to the aforesaid explanation. 

Mf 1f2actv = Mf 1f2act • V Eq. 1 3 

39 

[0215] Then, Mf If2act is filtered through a low-pass filter to obtain Mf 1f2actvf lit. 

[0216] Then, the V-directlon-component of feet compensating moment Mdmddbv is passed through a filter for com- 
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pensatlon and the filtered result le subtracted from Mf1f2actvflit to determine a V-dlrection-component of difference 
moment Mdiffv. 

p)217] The filter for compensation Is a fitter for Improving the frequency-response characteristic of the transfer func- 
tion from Mdmddbv to the actual total floor reaction force's moment. 
0 [021 8] Then, a feet deform compensating angle 6 ffdbv for canceling the influence of the deformation of the spring 
mechanism, etc., on the V-directlon- component of feet compensating moment This oon^sponds to the so-called 
feedforward compensation. 

[0219] Specifically, this Is done by using a mechanism-compliance model describing the relationship between the 
V-dirscUon-component of feet compensating moment l\/ldmddbv and the amount of deformation, by calculating the 
io angle of defonmatlon of the line between the desired 1 st foot floor reaction force central point Q1 and the desired 2nd 
foot floor reaction force central point Q2| and by inverting the polarity of the angle to detemiine the same as the feet 
defomn compensating angle Offdbv. 

[0220] The feet deform compensating angle effdibv can be approximated using the following equation. 

effdbv s - a * Mdmddbv Eq. 1 4 

[0221] In the above, a is a predetemnlned constant. 

[0222] Rnally. the feet compensating angle 0 dt>v Is obtained in accordance with the following equation. Below, Kdb 
20 is a control gain and Is normally set to be a positive value. 

Odbv = Kdb* Mdrffv + Offdbv Eq. 1 5 

2s [0223] The n-th foot compensating angle determinator will be explained. Figure 25 is a block diagram showing the 
calculation of a 1 stfoot X-compensatIng angle detemninator thereof. The 1st foot X-compensatIng angle 6lx is calculated 
in the manner illustrated. Although the illustration is omitted, the 1st foot Y-compensatIng angle Oly, the 2nd foot X- 
compensating angle e2x and the 2nd foot Y-connpensatIng angle e2y are cabulated similarly. Only the algorithm to 
detemnlne the 1st foot X-compensating angle 61x will be explained here. 

30 [0224] The X-component of the 1 st foot floor reaction force's moment M 1 actx is filtered through a low-pass filter to 
obt£iin M 1 actfil tx. The X-component of the 1 st foot compensating moment Mdmdix is passed through a fitter for com- 
pensation and the filtered result is subtracted from Mlactfiltx to obtain a difference moment Mdifflx. Similarly to the case 
of feet compensating angle determination, the filter for compensation Is a filter for improving the frequency-response, 
characteristb of the transfer function from Mdmdix to the actual floor reaction force. 

39 [0225] Then, similarly to the case of feet compensating angle detennination, the 1st foot X-defomi compensating 
angle ^1x for canceling the influence of the defomation of the spring mechanism, etc., on the X-component of 1st 
foot compensating moment, Is detemnlned. This Is the so-called feedfonvard compensation. 

[0226] Specifically, this is done by using a mechanism-compliance model describing the relationship between the 
X-dlrectlon-component of 1 st foot compensating mornent Mdmdl x and the amount of defonmatlon, by calculating the 

40 angle of deformation of the 1st foot, and by Inverting the polarity of the angle to detemnlne the same as the feet deform 
compensating angle Off 1x. . . . . ^ _ . 

[0227] The feet deform compensating angle 0 ffix can be approximated using the following equation. 

affix = -alx* Mdmdtx Eq. 16 

[0226] In the above, a1 x Is a predetemnined constant. 

[0229] Rnally, the let foot X-compensating angle 61x Is obtained in accordance with the following equation. In the 
below, Klx is a control gain and is normally set to be a positive value. 

59 

81 x» Klx* Mdifflx Off 1x Eq. 17 

[0230] Any equivalent alteration such as altering the order of calculation may be made on the block diagrams illus- 
5s trated. 

[0231] Returning to the explanation of Figure 18 and continuing the explanation thereon, the connected desired feet 
position and/or posture calculator corrects the desired feet position and/or posture, in accordance with the feet position 
and/or posture correction which is a development of the aforesaid composite compliance operation, based on the 
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aforesaid feet compensating angle Ocflbv. the 1st foot X-compensatlng angle 61 x, the 1st foot Y«compensating angle 
Oly, the 2ncl foot X-compensating angle 02x, the 2nd foot Y-compensatIng angle 02y, and an In-phase compensating 
dlsplacenr^nt (explained later) to determine the corrected desired feet position and/or posture. 
[0232] A def onm amount calculator calculates the amount of deform of the spring mechanism 32 and the sole elastic 

9 member 34 which Is expected to be generated by the desired foot floor reaction force. 

[0233] The corrected desired feet posttlon/posture with deform compensation calculator further corrects the corrected 
desired feet position and/or posture so as to cancel the calculated amount of deform, and detemnines the corrected 
desired feet position and/or posture with defonn compensation. 

[0234] For example, when the amount of deform such as shown in Rgure 26 is calculated, the corrected desired 

10 feet position/posture with defomi compensation is determined to be the position and/or posture as illustrated In Rgure 
27 In thick lines. In other words, the calculator calculates the connected desired feet position and/or posture with deform 
compensation such that the position and/or posture of the deform-compensated foot (illustrated in Figure 27) after 
having defomned by the desired foot floor reaction force, becomes equal to the foot position and/or posture before 
deform compensation when no floor reaction force Is acting (illustrated In Figure 26). 

[0235] The defonm compensation Is a control which cancels a difference of the actual foot position and/or posture 
caused by the deformation of the spring mechanism 32 or the sole elastic member 34 in a f eedfonward manner, thereby 
enabling to effect a walking which Is closer to the desired gait when compared to a system without thl^ defomi com- 
pensation control. 

[0236] Based on the above, again returning to the explanation of the flow chart of Figure 10, the aforesaid compen* 
^ sating angles are determined in S34. 

[0237] Rgure 28 is a flow chart showing the subroutine of this determination. 

[0238] Explaining this with reference to the figure, the program t)egins in SI 00 in which the aforesaid vector V is 
calculated and proceeds to SI 02 In which the distribution-weight variables at the current time t are calculated based 
on the set characteristk;s shown in Figure 20. The program then proceeds to 3104 in which the compensating total 
^5 floor reactk>n force's nwment Mdmd is distributed to, or divided into the feet compensating moment Mdmddbv and the 
foot compensating moment IMdmdnxCy) according to Eqs. 3 and 4. to 81 06 in which the feet compensating angle Odbv 
Is determined in the manrier mentioned above. And, the program proceeds to SI 08 in which the foot compensating 
angle 0 nx(y) is determined. 

[0239] Returning to the flow chart of Figure 10, the program then proceeds to 835 in which the in-phase compensating 

30 displacement Is determined (explained later). 

[0240] The program then proceeds to S36 in whk^h the amount of deform compensation is calculated based on the 
desired foot floor reaction force, to S38 in which the desired feet position and/or posture Is connected based on the 
compensating angles edbv, 0nx(y), and the in-phase compensating displacement and is then con-ected based on the 
amount of defomi compensation to determine the conrected feet position and/or posture with deform oompenscrtion. 

3s [0241] TTie program then proceeds to S40 in which the joint displacement commands are calculated based on the 
body position and posture and the corrected desired feet position and/or posture with defonT) compensation, to S42 in 
whk^h the actual joint displacements are servo-controlled based on the calculated joint displacement commands, to 
844 In which the time is updated by At, and returns to SI 4 to repeat these procedures. 
[0242] Here, the processing In S31 and S35 in the flow chart of Figure 1 0 will be explained. 

40 [0243] The processing in these steps Indicates to detect the body acceleration and to determine the force component 
(desinsd value) Fdmd of the compensating total floor reaction force based on the control law (explained later) in such 
a manner that the detected body acceleration becomes neither excesshre nor too snnall, and controls to parallel-trans* 
late the two feet In the same direction simultaneously such that the high frequency component of the force component 
of the actual total floor reaction force becomes close to that of Fdmd. 

^ [0244] By conducting this control, even rf the robot 1 falls due to an unexpected level difference and the foot 22 R (L) 
stomps on the floor, for example, It becomes possible to raise the two feet 22R (L) slightly in the vertical direction such 
that the foot-landing impact is absorbed. 

[0246] Aside from the above, the robot 1 has the natural vibratton due to the elasticity of the spring mechanism 32 
and the sole etastte member 34 and due to Its mass. With this, the body 24 of the robot 1 vibrates up and down during 
S9 walking. Although the vibration la slight in terms of the magnitude of displacement, the force component Fz in the Z 
direction of the actual foot floor reaction force fluctuates greatly. 

[0246] If the amplitude of the vibration grows excessive, the contactability of the foot 22R(L) with the floor degrades 
and the robot may occasionally spin. This control alms to suppress such a vibration and to enhance the posture stability 
by preventing the spinning from occurring. For that reason, in this embodiment, the system proposed eartler is added 
with a Z-directlon body acceleration controller, as shown in the bottom of Rgure 4. 

[0247] The Z-dlrectlon body acceleration controller detennlnes the force component (desired value) Fdmd of the 
compensating total floor reaction force such that the actual body aoceleretion Gbody detected by the inclination sensor 
60 (more epecifically, the detected actual vertical body acceleration Gbodyz) does not deviate from a body acceleration 
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in the desired gait (i.e. a desired body acceieration) Gbodyref. This corresponds to the processing in S31 . 
[0248] Explaining the processing, Fdmd should be catcuiated, for example, as follows. To be more specif fc, naming 
the X-component of Gbodyref as Gbodyrefx, the Y-component thereof as Gbodyrefy and the Z-component thereof as 
Gbodyrefz, the difference or error Fdmdtmp between the desired value and the detected value should be calculated 
5 as foliows. 

Fdmdtmpx = -Kgx * (Gbodyz - Gbodyrefz) 
Fdmdtmpy = -Kgy * (Gbodyz - Gbodyrefz) 

Fdmdtmpz = -Kgz * (Gbodyz - Gbodyrefz) Eq. 1 8 

[0249] In the above. Kgx, Kgy and Kgz are control gains (constants). Fdmdtmpx, Fdmdtmpy and Fdmdtmpz are the 
*5 X-component, Y-componenl and Z-component of the above-mentioned difference Fdmdtmp. which are generally 
named the difference Fdnrxitmp. The calculated difference Fdmdtmp is then passed through a filter (appropriately 
designed for improving control characteristics). The output of the filter is Fdmd. 

[0250] Defining a vector whose initial point Is the desired total floor reaction force central point and whose terminal 
point is the position of the center of gravity of the robot, as (Jx. Jy, Jz). the ratio of the abovenmentioned Kgx, Kgy, Kgz 

so should preferably be equal to Jx, Jy, Jz. With this, Fdmd will have the same direction as that of the vector (Jx, Jy, Jz). 
[0251] As a result, when Fdmd is generated as an additional floor reaction force at the desired total floor reaction 
force central point, since Fdmd acts towards the position of the center of gravity of the robot, no moment to rotate the 
robot 1 is generated. Accordingly, this does not influence on the posture inclination of the robot 1 . If the amount of 
paraiiehtranslation of the feet detennined by Fdmd is slight, Kgx and Kgy may be made zero, since, if doing so, this 

2s also makes no influence on the posture inclination of the robot 1 . 
[0252] The processing in S35 will then be explained. 

[0253] Outlining It with reference to Rgure 29, in order to manipulate the force conrponent of the actual total floor 
reaction force, the corrected desired 1st foot position yjsosture (shown by thin lines in Figure 29) obtained by the pro- 
cedures up to S38, is parallel-translated, without changing its posture, a displacement amount (vector) L1 . 
30 [0254] Similarly, the connected desired 2nd foot position/posture is parallel-translated, without changing its posture, 
by a displacement amount (vector) L2. The corrected desired 1st foot position/posture and the corrected desired 2nd 
foot position posture are shown In Rgure 29 by thick tines. 

[0255] These are a compliance control conducted on the force component of the actual total floor reaction force, and 
is named "in-phase compensating displacement** in this specification. The displacement amount (vector) Ln indicates 

39 a specific amount of compensating displacement for n-th foot (n = 1,2). 

[0256] Specifically, as shown in the bottom of Figure 18, an in-phase compensating displacement calculator Is pro- 
vided which calculates the in-phase compensating displacement for the respective feet based on the force component 
(desired value) of the compensating total floor reaction force and the force component of the actual total floor reaction 
force. The corrected desired feet position/posture calculator calculates the conected desired feet position/posture 

40 including the calculated In-phase compensating displacement for the respective feet. 

[0257] Rgure 30 Is a block diagram showing the calculation In more details and Figure 31 Is a flow chart showing 
the processing illustrated in Rgure 30. 

[0258] Explaining this with reference to Rgure 31 , the program begins in S200 In which the force component Ftotalact 
of the actual total floor reaction force is calculated. More specifically, this actual total floor reaction force's force com- 
49 ponent Ftotalact is calculated based on the force component flact of the actual 1st foot floor reaction force and the 
force component f2act of the actual 2nd foot floor reaction force, using a following equation (Eq. 19). 

Ftotalact = F1 act -I- F2act Eq. 1 9 

50 

[0259] The program then proceeds to S202 in whteh a difference or error Ftotalerr Is calculated by subtracting the 
desired total floor reaction force (more precisely, the force component Fref in the desired gait). The program then 
proceeds to S204 in which the cateulated value Is passed through a filter (appropriately designed) to obtain Ftotalerrfltt. 
[0260] The program then proceeds to S206 In which the force component (desired value) Fdmd of the compensating 
55 total floor reaction force is passed through a filter (for compensation) and by subtracting Rotalerrfllt from the filtered 
value, the difference Ftotafdiff is determined. The filter (tor compensatton) is installed to improve the frequency response 
from Fdmd to the force component of the actual total floor reaction force. 

[0281] TDe program then proceeds to S208 in which the in-phase compensating displacement (vector) L is calculated. 
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L = K1 ♦Ftotaldlff 



Eq.20 



[0262] In the above» K1 Is a control gain (constant; scalar quantity). 
9 [0263] Then, the catculated value (vector) L is distributed to the respective feet using a following equation. 



[0264] In the above, W11 and W12 are attenuaters (weights) and are set, for example, as illustrated In Figure 32. 
[0265] W1 1 and W1 2 may always be set to 1 . However, it is preferable to set that of the lifted foot (i.e. 2nd foot 22R 
(L) during one-leg supporting period) to be 0, in order to prevent it from being moved wastefulty after lifting. 

t9 [0266] In S36 of the flow chart In Figure 10, the corrected desired feet position /posture with deform compensation 
is detenmined or calculated based on the values including the in-phase compensating displacement Ln. 
[0267] Specifically, the corrected desired feet positiorv/posture is detennined or calculated In accordance with th& 
composite compliance operation including the iri-phase compensating displacement, based on the feet compensating 
angle 6 dbv, the 1st foot X-compensatIng angle eix, the Ist foot Y-compensating angle eiy. the 2nd foot X-compen- 

20 sating angle 62x, the 2nd foot Y>compensating angle 62y, the let foot fafi-phase compensating displacement LI and 
the 2nd foot in-phase compensating displacementL2. 

[0268] Since this embodlnrtent is configured in the manner mentioned above, briefing this embodiment, almost no 
interference between the actual total floor reaction force control and the actual foot floor reaction force control occurs, 
thereby enabling to facilitate control of the actual total floor reac^on for%:e and the actual foot floor reaction force. 

2s [0269] To ise specific, the system according to this embodiment has Improved the following with respect to the tech- 
nique proposed earlier. That is, in the ankle-compliance control proposed in Japanese Laid-Open Patent Application 
No. Hei 5 (1993) - 305. 584. the actual floor reaction force's moment acting on a fixed point at the foot such as the 
anide or a reference sole point is detected and the foot is rotated about the point in response to the detected moment. 
In the system according to this embodiment, the actual foot floor reaction force's moment acting on the moving desired 

30 foot floor reac^on force central point is catculated, and the control Is modified in such a manner that the foot Is rotated 
about the desired foot floor reaction force central point In response to the calculated moment such ttiat the moment 
about the point becomes a desirable value. 

[0270] As a result, ft becomes possible to easily control the actual total floor reaction force and the actual foot floor 
reaction force, with almost no Interference therebetween. In order to further minimize the Interference, it is alternatively 
99 possible to select the point of action at a more appropriate location within the floor-contact sole region at every instant. 
[0271] Accordingly, the system can appropriately control the floor reaction force acting on the robot, even when 
walking on the ftoor having not only a slant or undulation extending over a relatively long distance, but also on an 
unexpected local slant or level difference, without being affected thereby. 

[0272] Furthenmore, the system can control the floor reaction force acting on the robot, more specifically, the actual 
40 total floor reaction force's moment about the desired total floor reactton force central point (desired ZMP) and the actual 
foot floor reaction force's moment about the desired foot f k>or reaction force central point easlty and appropriately. In 
other words, comparing with the case that the two-leg-compliance control and the ankle-compliance control proposed 
earlier are both used, less control Interference occurs and the system can prevent the actual total floor reaction force 
and the adual foot floor reac^on force from deviating from desired values, and the oscillation from happening. 
45 [0273] Furthermore, the system is configured such that the compliance control is conducted on the force component 
of the actual floor reaction force acting on the robot, even if the robot walks on the floor whose level is different than 
expected, resulting In the Increase in the foot-landing Impact, the system can absorb the foot-landing impact and to 
enhance the contactablllty of the robot foot with the floor, while ensuring to prevent the spinning from occun^lng. 
[0274] Furthemnore, the system can ach ieve the postu re stabilization control of a legged mobile robot easily, decrease 
so the foot-landing impact acting on the legged mobile robot, and enhance the contactabiiity with the floor so as to prevent 
the slippage or spinning at walking from happening. The system can decrease the load to be exerted on the actuators 
of the legged mobile rot>ot. 

[0275] Again, the distrlbutton of the In-phase compensating displacement L to each foot will be discussed. As men- 
tioned with reference to Eq. 21 , the weights W11 , W12 are always fixed to 1 .0 or the weight for free leg is fixed to 0. 
55 In oth er words, they are fixed with respect to the f req uency of the force component of the actual total floor reaction force. 
[0276] When setting the weights in this manner, it becomes Impossible to control the low frequency component of 
the force component of the actual total floor reac^on force, as desired. The reason is that, if the feet are In-phase 
paraliei-translated vertically In the direction of gravity when the robot is upright, i.e.. if the robot legs are contracted, 



L1=W11 •L 



10 



L2=W12*L 



Eq. 21 
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for example, the force component of the actual total floor reaction force only decreases at that moment, but Increases 
to the Initial value In response to the downward movement of the body 24 immediately succeeding thereafter. 
[0277] If an Integration factor Is added to Eq. 20 so as to solve this problem, it will be possible to control even the 
low frequency component of the force component of the actual total floor reaction force. However, it Is not preferable 

9 to add the Integration factor, since It couid make the robot lose the dynamic balance when the body height deviates 
greatly from the desired gait during high-speed walking. 

[0278] For that reason, the distribution of the in-phase compensating displacement L may be different for feet or may 
be varied with respect to the frequency of the force component of the actual total floor reaction force. In other words, 
It may be configured such that the weights have frequency characteristics. 

10 [0279] Spedflcaily, the weights W11 , W12 should preferably be set to be variable with respect to the frequency of 
the force component of the actual total floor reaction force, as shown in Figure 33. iViore spedflcaliy, in a range of 
frequency sufficiently lower than a predetermined level such as 5 Hz, the ratio of the weights W11, W12 is should 
preferably be 1 .0 or thereabout, while it should preferably be variable in a revige of frequency not less than the prede- 
termined level. 

15 [D280] For example, they should preferably be set such that LI : L2 = 1 : 1 1n the range of frequency lower than 6 Hz. 
Since the body 24 moves greatly in the direction of gravity in response to the contraction or expansion of the foot 22R 
(L) with respect to the k>w frequency component of the force component of the actual total floor reaction force, the 
weights should preferably be set to be the same value so as to prevent either of the feet from being lifted. 
[0281] On the other hand, In the range of frequency not less than 5 Hz, the In-phase compensating displacements 

^ L should preferably be distributed in Inverse proportion to the distance between the desired total floor reaction force 
central point P and the corrected desired n-th foot floor reaction force central point Qn' (illustrated in Figure 29) such 
that no moment is generated about the desired total floor reaction force central point P. More specifically, it should 
preferably be distributed such that U:LZ= PQ2' : PQV. 
[0282] The expressions shown In Eq. 1 8 may be generalized as follows. 

Fdmdtixqpxs -Kgxx * (Gbodyx - Gbodyiefx) 

— Kgxy * (Obodyy— Obodyiefy) 

—Kgja* (Gbodyz -Gbodyiefe) 
Fdmdtmpy ss— Kgyx ♦ {Gbodyx - Gbodyrefit) 

— Kgyy * (Gbodyy- Gbodyiefy) 

— Kgyz* (Gbodyz— Gfoodyrefz) 
4o FdmdtmpZ£=-Kg2x ^ (Gbodyx— Gbodyiefx) 

— Kggr * (Gbodyy— Gbodyreiy) 

— Kgzz * (Gbodyz- Gbodyxefe) 

45 

Eq. 22 



[0283] In the above, Kgxx, Kgxy, Kgxz, Kgyx, Kgyy, Kgyz. Kgzx, Kgzy and Kgzz are control gains. 
s(> [0284] It should be noted that, in the embodiment mentioned above, If the body acceleration detection and the control 
law to determine the force component (desired value) of the compensating floor reaction force are omitted such that 
Fdmd Is fixed to zero or thereabout, it will still be effective, to a fair extent, as a kind of the conrpliance control on the 
force component of the actual total floor reaction force. Claim 13 is based on this. 

[0285] Rgure 34 is a block diagram showing, In a functional manner, the configuration and operation of a control 
59 system of a legged mobile robot (mainly corresponding to the first calculator 80 In Figure 3) according to a second 
embodiment of the present invention. 

[0286] The control system of a legged mobile robot according to the second embodiment alms to further Improve 
the technique proposed eariler and to control the force component of the actual foot floor reaction force independently, 
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thereby enhancing posture stabilization so as to prevent the spinning or the tike from happening and enabling to de- 
crease the load to be exerted on the Joint actuatorB. 

[0287] Specifically, In the first embodiment, among of the aforesaid six Idnds of modes, Modes 1 , 2 and 6 have been 
discussed, in the second embodiment, in addition thereto, a control on an internal force, which does not influence on 
5 the total behavior of the robot (Modes 1 to 6)» is conducted, iiere, the ''Internal force" indicates a combination or com* 
binations of components of the foot floor reaction force, which does not influence on the total floor reaction force. 
[D288] Rgure 35 Is a flow chart, similar to Rgure 1 0, but showing the operation of the system according to the second 
embodiment. 

[0269] Explaining this with the focus on the differences from the first embodiment, the program begins in S10 and 
proceeds up to S32 to conduct the same procedures as those of the first embodiment. Tlie program then proceeds to 
S34 in which the feet compensating angle 6dbv and the foot compensating angle Onx(y) are detemnlned, and proceeds 
to S35 in which an Internal force compensating displacement is detemnined. 

[0290] The processing In S35 Is conducted by the composite compliance operation determlnator. Rgure 36 Is a blocic 
diagram, similar to Rgure 16, but showing the calculation of the composite compliance operation detenninatoraccord- 

1^ Ing to the second embodiment 

[0291] As will be understood from Rgure 36, in the second embodiment, the corrected desired feet posltion/tposture 
calculator conects the desired feet positlon/jposture to determine the conrected desired feet position^osture. using a 
concept of the foot Internal force compensating displacement, Instead of the in-phase compensating displacement 
used In the first emt>odiment Specifically, It detemnlnes the corrected desired feet position /posture based on the 

^ Intemal force compensating displacement and the aforesaid feet compensating angle 0 dbv in accordance with a tech- 
nique of feet position/posture correction which Is a development of the aforesaid composite compliance operation. 
Accordingly, the second embodiments needs no processing in S31 . 

[0292] Explaining the calculation of the intemal force displacement compensating displacement conducted in S35, 
with the control conducted in the procedures other than S3S, it becomes possible to Independently control the moment 
^ component of the actual total floor reaction force (which Influences the total behavior of the robot) and the moment 
component of the actual foot fioor reaction force. IHowever, it is still impossible to independently control the force 
component of the actual foot floor reaction force of each foot 

[0293] Since It has been possible to control the sum of the force components of the actual foot fioor reaction force 
In the first embodiment, in order to independently control the force component of the actual foot floor reaction force of 
30 each foot, it suffices if the difference between force components of the actual foot floor reaction force of both feet is 
additionally controlled. The processing in 335 indicates this added control, which Is hereinafter refenred to as "intemal 
force compliance control". 

[0294] This control functions to Increase or decrease the distance between the desired 1 st foot and the desired 2nd 
foot to a slight extent in such a manner that the respective force components of the foot floor reaction forces of the 

39 feet are generated In the direction of a segment connecting the feet, which are opposite from each other with respect 
to each of the feet. This is hereinafter refenred to as "out>of-phase parallel-translatlon". 

[0295] With this control, it becomes possible to change the ratio of the force components of the actual 1st foot and 
2nd foot, without causing interference with the control obtained by the processing (other than that In S35) with respect 
to the moment component of the actual total floor reaction force and the actual foot floor reaction force. Accordingly. 

40 by changing the ratio appropriately, it becomes possible to, for example, Increase the force to propel the robot In the 
advance direction for the foot whose floor-contact pressure is high, while decreasing that~fof the foot whose floor- 
contact pressure Is low and to enhance the posture stability of the robot such that the slippage can effectively be 
suppressed. 

[0296] Furthemnore, It becomes possible to solve the problem that one foot being a load to the force generated tsy 
4' the other foot to propel the robot in the advancing direction and some similar problems, thereby enabling to decrease 
the load to be exerted on the Joint actuators. 

[0297] Addressing this, in the second embodiment, an Internal force compensating displacement calculator is added 
In the system proposed earlier, as illustrated at the bottom of Rgure 36. Specifically, the internal force compensating 
displacement calculator and the corrected desired feet position/posture calculator (which Inputs the calculated Internal 
so force compensating displacement) adds manipulation mentioned In the following to the connected desired feet position/ 
posture obtained In the processing other than 835. 

[0296] Rgure 37 Is a blocic diagram showing the processing of the Intemal force compensating displacement calcu- 
lator In detail and Rgure 38 is an explanatory graph showing the out-of-phase parallel-translation obtained therefrom. 
As Illustrated in Rgure 37, the Internal force compensating displacement calculator calculates the Intemal force com- 
S5 pensating displacement for each foot Dn (n= 1,2), shown in Rgure 38, based on the force component of the actual 
foot floor reaction force and the force component of the desired foot floor reaction force. The corrected desired feet 
posltlon/|3osture calculator calculates the corrected desired feet position/posture, through the geometrical calculation, 
based on the parameters Including the internal force compensating displacement Dn. 
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[0299] Outlining this with reference to Figure 38, it is first required to detemilne a vector whose initial point Is QV 
and whose tennlnal point is Q2' and a direction vector having the same orientation and the magnitude of 1 , which is 
hereinafter refen^ to ae "V". 

[0300] Then, without changing its posture, the conrected desired 1 st foot (obtained by the processing other than S36) 

9 Is parallei-dispiaced by D1 V. As iliustrated, D1 indicates the amount of translation of the con-ected 1st foot In the 
direction of V, which Is hereinafter refen'ed to as "1st foot Internal force compensating displacement". D1 is a scalar 
variable. 

[0301] Similarly, without changing its posture, the corrected desired 2nd foot is paralleNtranslated by D2V*. D2 indi- 
cates the amount of translation of the con-ected 2nd foot in the direction of V which is hereinafter referred to as "2nd 

10 foot Internal force compensating displacemenr. 02 is also a scalar variable. In the situation illustrated, D1 Is negative 
and D2 is positive. Since, 01 and 02 are nonnally opposite from each other In polarity, the feet movement becomes 
out of phase. The above Is the aforesaid out-of-phase parallel-translation. 

[0302] The above will be explained in more detail with reference to the flow chart of Rgure 39. 
[0303] The program begins In S300 in which the distribution-weight variables Wdl, Wd2 at current time t, whose time- 
13 varying characteristics are Illustrated in Figure 40, are calculated. 

[0304] The program then proceeds to S302 In which an error or difference Fderr is calculated based on the force 
component of the actual foot floor reaction force and the force component of the desired foot floor reaction force using 
Eq. 1 9a. Specifically, the en^r Fderr Is calculated from the force component F1 act of the actual 1 st foot floor reaction 
force, the force component F2act of the actual 2nd foot floor reaction force, the force component F1 ref of the desired 
1 st foot floor reaction force and the force component F2ref of the desired 2nd foot floor reaction force, using the following 
equation (Eq. 19a). 
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Fderrt = F2act - F1 act- {P2ref- F1 ref) Eq. 1 9a 



[0305] In the above, the force component F1 ref of the desired 1 st foot floor reaction force and the force component 
F2ref of the desired 2nd foot floor reaction force are values in the aforesaid desired gait 

[0306] The program then proceeds to S304 in which the calculated error Fderr is passed through a low-pass filter 
and the filtered value Is multiplied by a gain Kd to calculate a difference Diff. 
30 [0307] Tbe program then proceeds to S306 in which the 1st foot internal force compensating displacement D1 and 
the 2nd foot internal force compensating displacement 02 are calculated using following equations (Eq. 20a and Eq. 
21a) 



01 s Wdl * Odiff Eq. 20a 

D2 = Wd2 * Odiff Eq.21a 

> 40 [0308] Here. Wd1 and Wd2 are nonnegative distribution-weight variables. When the sum of Wd1 and Wd2 are 1 , 
^ Odiff indicates the amount of increase of the distance between the corrected desired 2nd foot and the corrected desired 

1st foot. 

[0309] The distribution-weighted variables Wdn are, for example, preset as shown in Figure 40. in the illustrated 
example, they are preset taking the following into account. Specifically, if the foot Internal force compensating dlsplace- 
45 ment changes discontinuously, excessive torque could be generated at the joints. Wdn should accordingly be preset 
such that the displacement changes continuously. 

[0310] Further, If Wdn has not reached zero at or near the time when the foot Is landed, the foot landing position 
could deviate from the desired position, resulting in a bar to this internal force compensating displacement control. 
Accordingly, Wdn should be made zero at or near the time when the foot is landed. In addition, since no control is 
so needed during the one-leg supporting period, Wdn should be Icept zero during that period. The sum of Wdl and Wd2 
should be made 1 during the two-leg supporting period or when the robot Is upright. 

[03t1] In S38 of the flow chart of Figure 35. the corrected desired feet position /k>osture with defomi compensation 
is calculated using values Including the, thus obtained, compensating displacement On. 

[0312] To be more specific, the corrected desired feet position/posture Is calculated based on the feet compensating 
59 angle 0 dbv, the 1st foot X-compensating angle Olx, the 1st foot Y-compensating angle Oly, the 2nd foot X-compen- 
sating angle e2x, the 2nd foot Y-compensatIng angle 02y, the 1st foot Internal force compensating displacement 01 
and the 2nd foot internal force compensating angle 02, In accordance with the composite compliance operation in- 
cluding the aforesaid parallel-translation. 
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[0313] Having been configured in the foregoing manner, briefing the second embodiment, similar to the first embod- 
iment, the actual total floor reaction force control and the actual foot floor reaction force control interferes little with 
other. The system can control them easily. 

[0314] Specifically, In the second embodiment, similarto the flrst embodiment, the technique proposed earlier Is also 
modified In such a manner that the moment of the actual foot floor reaction force about the moving desired foot floor 
reaction force central point Is calculated and based thereon, the feet are rotated about the desired foot floor reaction 
force central point as the center In such that the moment about the point is controlled to a desirable value. With this, 
It becomes possible to easily conduct the control without causing little Interference between the actual total floor reaction 
force and the actual foot floor reaction force. 

[0315] As a result, in the second embodiment, the floor reaction force acting on the robot can be appropriately con- 
trolled, even when walWng on the floor having not only a slant or undulation extending over a relatively long distance, 
but also on an unexpected local slant or level difference, without being affected thereby. 

[0316] Further, the embodiment Is configured such that the force component of the actual foot floor reaction force of 
each fool Is controlled Independently, the system can enhance the posture stability, thereby ensuring to effectively 
prevent the slippage from occurring and decreasing the load to be exerted on the actuators of the legged mobile robot. 
[0317] The first embodiment and the second embodiment are thus configured to have a system for controlling a 
legged mobile robot having at least a body (body 24) and a plurality of (two) legs (leg links 2) each connected to the 
body through a flrst joint (10, 12, 1 4R(L)) and having a foot (foot 22R(L)) connected to Its distal end through a second 
Joint (18, 20R(L)), comprising: gait generating means (gait generator, S10 - S22) for generating a gait of the robot 
including at least a motion pattem Including at least a desired position and a posture of the foot (desired body position 
and/or posture, desired feet position and/or posture), and a desired pattem of a total floor reaction force acting on the 
robot (desired total floor reaction force, desired total floor reaction force central point (desired ZMP)); desired foot floor 
reaction force central point determining means (desired floor reaction force distributor, S24 - S26) for determining a 
desired foot floor reaction force central point indicative of a point of action on the foot when the total floor reaction force 
in the generated gait is distributed to each of the feet (desired foot floor reaction force central point); actual floor reaction 
force detecting means (force sensor 44, actual foot floor reaction force detector, S32) for detecting an actual floor 
reaction force acting on the foot (actual foot floor reaction force); foot rotating amount detennlnlng means (composite 
compliance operation determlnator. S32 - S34, feet compensating angle detemiinalor. n-th foot compensating angle 
determlnalor, SI 00 - SI 08) for determining a foot rotating amount for rotating the foot (feet compensating angle edbv. 
z. n-th foot compensating angle 6nx, y, z) based on at least the detected actual floor reaction force; first foot position/ 
posture conwting means (composite compliance operation detennlnator, S38, 840, conrected desired feet posttion / 
posture calculator) for connecting the desired position and/or the posture of the foot such that the position and^or tiie 
posture of the foot rotates based on the detennlned foot rotating amount; compensating displacement calculathg 
means (Z-direction body acceleration controller, in-phase compensating displacement calculator, 531, S36, 5200 - 
S208) for calculating a compensating displacement of the foot (Ln) based on at least tfie detected actual floor reaction 
force; second foot posltion/|:>osture correcting means (Z-dlrection body acceleration controller, In-phase compensating 
displacement calculator, S38) for con^ting the desired position and/or the posture of the foot based on the calculated 
compensating displacement; and joint displacement means (robot geometric model (inverse kinematic solution), dis- 
placement controller. 840, 842) for displacing tiie first Joint (10, 12, 14R(L)) and tiie second Joint (18, 20R(L)) of the 
robot based on at least the corrected position and/or posture of the foot oon-ected by tiie first foot position^osturB 

correcting means and the second foot position posture correcting means. ' 

[0318] Further, tiie system is configured such that tiie foot rotating amount detenmlning means calculates a moment 
acting about the detemrilned desired foot floor reaction force central point (actual n-th foot floor reaction force's moment 
Macbc. y. z) and determines the foot rotating amount for rotating the foot (feet compensating angle 8 dbv.z, n-th ft)ot 
compensating angieOnx, y, z) based on at least the calculated moment, and ttie compensating displacement calculating 
means detenmines a force component of an actual total floor reaction force (Ftotalact) based on tiie detected actual 
floor reaction force to calculate an en-or (Ftotalerr) between the detennlned force component and a force component 
of the total floor reaction force In tiie generated gait (Fref) and calculates the compensating displacement (Ln) baaed 
on the calculated error. 

[031 9] Further, the system Is configured such that the first foot position/posture correcting means con-ects the desired 

position and/or the posture of the foot based on the detemiined foot rotating amount such that ttie position and/br the 

posture of ttie foot rotates about the desired foot floor reaction force central point or thereabout. 

[0320] Furtiier. the system Is configured such that the flrst foot position/jaosture correcting means conects the desired 

position and/or the posture of tiie foot based on the detemiined foot rotating amount such that the position and/br the 

posture of ttie foot rotates about the desired foot floor reaction force central point or thereabout. 

[0321] Further, the system Is configured such ttiat It incIudes:foot moving amount determining means (composite 

compliance operation detennlnator, S34, feet compensating angle detemilnator, S100 - 51 08) for detennlnlng at least 

one of a moment of total floor reaction force actually acting on the robot (more precisely moment components PQ1 • 
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F1 ad + PQ2 * F2act + M lact + M2act), and a moment (Mf 1 f2act » P01 * F1 act ^ PQ2 " F2act) obtained by subtracting 
a moment of the floor reaction force acting on the foot (Ml act 4- M2act) from the moment of total floor reaction force 
actually acting on the robot (PQ1 * Ract -i- PQ2 * F2act -4- Mlact-i- M2act), and for detemfilnlng a foot moving amount 
for moving the foot (e dbv, z) based on at least the determined moment; and the first foot position/posture con-ecting 
s means corrects the desired position and/or the posture of the foot based on the determined foot rotating amount and 
the determined foot moving amount. 

[0322] Further, the system Is configured such that a moment of a compensating total floor reaction force for posture 
stabilization to t>e added to the desired pattern of the total floor reaction force (compensating total floor reaction force's 
moment Mdmd) Is detenmlned, and the foot rotating amount determining means and/or the foot moving amount deter- 
10 mining means detemiines the foot rotating amount and/or the foot moving amount based on at least the detected actual 
floor reaction force (actual foot floor reaction force) and the determined moment of the compensating total floor reaction 
force for posture stabilization (S34, S100 -S108). 

[0323] Further, the system Is configured such that the nrwment of the compensating total floor reaction force for 
posture stabilization is detennlned based on at least an Inclination error of the robot (Oerrx, y, S28, S30). 
f 5 [0324] Further, the system Is configured such that the compensating displacement calculating means Includes: body 
acceleration detecting means (S31) for detecting a body acceleration of the robot(actual vertical body acceleration 
Gt>ody); and compensating total floor reaction forceps force component calculating means (S31) for calculating a force 
component (desired value of the force component Fdmd) of the compensating total floor reaction force for posture 
stabilization based on the detected t>ody acceleration; and calculate the compensating displacement of the foot based 
on a difference (Ftotaldiff or L) obtained by subtracting the ennor from the calculated force component of the compen- 
sating total floor reaction force (S200 - S208). 

[0325] Further, the system is configured such that the compensating displacement calculating means distributes the 
compensating displacement of the foot to each of the feet by multiplying the difference (Ftotaldiff or L) by a predeter- 
mined weight (attenuators W11 , W12). 

[0326] Further, the system is configured such that the compensating displacement caicuiating means makes the 
weight zero when the foot is lifted. 

[0327] Further, the system is configured such that the compensating displacement calculating means, varies the 
weight in response to a frequency of the force component of the actual total floor reaction force. 
[0328] Further, the system Is configured such that the displacement calculating means calculates the compensating 
3o displacement of the foot with respect to a direction of gravity. 

[0329] Further, the system is configured such that the displacement caicuiating means calculates the compensating 
displacement of the foot with respect to a direction of a segment connecting a center of gravity of the robot and a 
desired total floor reaction force central point 

[0330] Further, the system is configu red such that the force component of the compensating total floor reaction force 

33 is set to zero or thereabout 

[0331] Further, the first embodiment and the second embodiment are configured to have a system for controlling a 
legged mobile robot having at least a body (body 24) and a plurality of (two) legs (leg links 2) each connected to the 
body through a first joint (10, 12, 14R(L)) and having a foot (foot22R(L)) connected to its distal end through a second 
Joint (18, 20R(L)), comprising: gait generating means (gait generator, S10 - S22) for generating a gait of the robot 
including at least a motion pattern Including at least a desired position and a p>osture of the foot (desired body position 
and/or posture, desired feet position and/or posture), and a desired pattem of a total floor reaction force acting on the 
robot (desired total floor reaction force, desired total floor reaction force central point (desired ZM P)); desired foot floor 
reaction force central point determining means (desired floor reaction force distributor, S24 - S26) for detenmining a 
desired foot floor reaction force central point indicative of a point of action on the foot when the total floor reaction force 

45 in the generated gait is distributed to each of the feet (desired foot floor reaction force central point); actual floor reaction 
force detecting means (force sensor 44, actual foot floor reaction force detector, S32) for detecting an actual floor 
reaction force acting on the foot (actual foot floor reaction force); foot rotating anrK)unt determining means (composite 
compliance operation detenninator. S32 • S34, feet compensating angle detemnlnator, n-th foot compensating angle 
determinator, S100 • S106) for calculating a moment which is generated about the desired foot floor reaction force 

so central point by the detected actual floor reaction force (actual n-th foot floor reaction force's moment Mactx, y, z) and 
for determining a foot rotating amount for rotating the foot (feet compensating angle edbv, z, n-th foot compensating 
angle Onx. y, z) based on at least the calculated moment; first foot posltlon/)308ture correcting means (composite com- 
pliance operation determinator, S38, S40, corrected desired feet position/posture calculator) for connecting the desired 
position and/or the posture of the foot such that the position and/or the posture of the foot rotates based on the deter- 
mined foot rotating amount; compensating displacement calculating means (internal force compensating displacement 
calculator, S35, S300 - S306) for detemilning an Internal force component (Fleet F2act) which does not Influence on 
an actual total floor reaction force based on the detected actual floor reaction force to calculate an error (Fderr, Ddlff) 
behA^een the determined internal force component and an Intemal force component In the generated gait (Firef 
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F2rer)i and for calculating a compensating displacement of the foot Pn) based on the calculated enor; second foot 
position/posture conrecting means (Z-dlroctlon body acceleration controller, fn-phase compensating displacement cal- 
culator, S38) for correcting the desired position and/or the posture of the foot based on the calculated compensating 
displacement; and joint displacement means (robot geometric model (Inverse Wnematic solution), displacement con- 
troller. S40. S42) for displacing the first Joint (1 0, 1 2. 1 4R(L)) and the second Joint (1 8. 20R(L)) of the robot based on 
at least the corrected position and/or posture of the foot con-ected by the first foot positlon/^oetura correcting means 
and the second foot position posture conBctIng means. 

[0332] More spedflcaily, the system Is configured such that the compensating displacement calculating means de- 
termines the intemal force component (F1 act + F2act), which does not Influence on an actual total floor reaction force, 
from the detected actual floor reaction force to calculate the error (Fderr, Ddiff) between the detemilned Intemal force 
component and the Intemal force component in the generated gait (Flref + F2re0, and calculates the compensating 
displacement of each of the feel based on the calculated en'or. (intemal force compensating displacement controller. 
335,8300 - 8306). 

[0333] Further, the first embodiment and the second embodiment are configured to have a system for controlling a 
legged mobile robot 1 having at least a body (body 24) and a plurality of (two) legs (leg links 2) each connected to the 
body through a first Joint (1 0. 12. 1 4R(L)) and having a foot (foot 22R(L)) connected to its distal end through a second 
joint (18, 20R(L)). comprising: gait generating means (gait generator, 310 - 322) for generating a gait of the robot 
including at least a motion pattern including at least a desired position and a posture of the foot (desired body position 
and/or posture, desired feet position and/or posture), and a desired pattern of a total floor reaction force acting on the 
robot (desired total floor reaction force, desired total floor reaction force central point (desired ZMP)); desired foot floor 
reaction force central point determining means (desired floor reaction force distributor, 324) for determining a desired 
foot floor reaction force central point Indicative of a point of action on the foot when the total floor reaction force in the 
generated gait Is distributed to each of the feet (desired fool floor reaction force central point); actual floor reaction 
force detecting means (force sensor 44, actual foot floor reaction force detector, 332) for detecting an actual floor 
reaction force acting on the foot (actual fool floor reaction force); foot rotating annount determining means (composite 
compDance operation detemnlnator, 332 • 334, feet compensating angle detennlnator, n-th foot compensating angle 
determinator, 31 00 - 3 1 08) for detemilning a foot rotating amount for rotating the foot (feel compensating angle e dbv, 
z. n-th foot compensating angle 6 nx, y, z) based on at least the detected floor reaction force; first foot position/JjosturB 
correcting means (composite compliance operation detemninator, S38, 840. conected desired feet position/posture 
calculator) for con-ecting the desired position and/or the posture of the foot such that the position and/or the posture 
of the foot rotates about the detennlned desired foot floor reaction force central point or thereabout, based on the 
detemiined foot rotating amount; compensating displacement calculating means (Z-direction body acceleration con- 
troller, In-phase compensating displacement calculator, 335, 3300 - 3308) for detemnining an intemal force component 
(Fleet F2act) which does not influence on an actual total floor reaction force based on the detected actual floor 
reaction force to calculate an en^r (Fderr, DdifO between the detennined Intemal force component and an Intemal 
force component in tfie generated gait (F1 ref+ F2ref). and for calculating a compensating displacement of the foot (On) 
based on the calculated error, second foot position/posture con-ecting means (Z-dlrection body acceleration controller. 
Ih-phase compensating displacement calculator, 338) for correcting the desired position and/or the posture of tiie foot 
based on the calculated compensating displacement; and joint displacement means (robot geometric model (inveise 
Wnenratic solution), displacement controller,S42) for displacing the first Joint (10, 12, 14R(L)) and the second joint (18, 
20R(L)) of the robot based on at least the corrected position and/or posture of the foot corrected by the f iret foot position/ 
posture correcting means and the second foot position posture correcting meevis. 

[0334] More specifically, the system is configured such that the foot rotating amount determining means (composite 
compHance operation detennlnator, 332 - 334, feet compensating angle detemninator, n-lh foot compensating angle 
detemninator. 3100 - 3108) detemilnes the foot rotating annount for rotating the foot (feet compensating angle 8 dbv, 
n-th foot compensating angle Onx, y, z) based on at least the detected actual floor reaction force, and the first foot 
position/posture con-ecting means (composite compliance operation detennlnator, S3B, S40, corrected desired feet 
position/posture calculator) corrects the desired position and/or the posture of the foot based on the determined foot 
rotating amount such that the position and^or the posture of ttie foot rotates about the desired foot floor reaction force 
central point or thereabout 

[0335] Further, the first foot position/posture connecting means corrects tiie desired position and/or the posture of 
the foot based on tiie detemnfned foot rotating amount such that the position and^or the posture of the foot rotates 
about the desired foot floor reaction force central point or thereabout. 

[0336] Further, the system is configured such that It includes:foot moving amount detemilning means (composite 
compliance operation determinator, 334, feet compensating angle determinator, 31 00 - 31 08) for determining at least 
one of a moment of total floor reaction force actually acting on the robot (more precisely moment components PQ1 • 
F1 act + PQ2 * F2act + M 1 act + M2act), and a moment (Mf 1 f2act « PQ1 * F1 act -i- PQ2 * F2acl) obtained by subtracting 
a moment of the floor reaction force acting on the foot {m act + M2act) from tiie moment of total floor reaction force 
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actually acting on the robot (PQ1 * F1 act -i- PQ2 * F2act + Mlact + M2actX and for determining a foot moving amount 
for moving the foot (6 dbv, z) tiased on at least the cletermined moment; and the first foot positJon/postura correcting 
means corrects the desired position and/or the posture of the foot based on the detemilned foot rotating amount and 
the detemifned foot moving amount. 
^ [0337] Further, the system Is configured such that a moment of a compensating total floor reaction force for posture 
stabilization to be added to the desired pattern of the total floor reaction force (compensating total floor reaction force's 
morhent Mdmd) Is detennined. and the foot rotating amount determining means and/or the foot moving amount deter- 
mining means detennlnes the foot rotating amount and/or the foot moving amount based on at least the detected actual 
floor reaction force (actual foot floor reaction force) and the determined moment of the compensating total floor reaction 
io force for posture stabilization (S34, SI 00 - S 1 08). 

[0338] Further, the system is configured such that a moment of a compensating total floor reaction force for posture 
stabilization is detennnlned based on at least an inclination en^or of the nsbot (Oen^, y, S2d, 30). 
[0339] Further, the system Is configured such that the compensating displacement calculating means distributes the 
compensating displacement of the foot to each of the feet by multiplying the difference (Fderr. DdifO by a predetermined 
*5 weight (Wdn). 

[0340] Further, the system is configured such that the predetermined weight lias time-varying characteristics and/or 
frequency characteristics. 

[0341] in the first embodiment and the second embodiment, the spring nnechanism 32 (and the sole elastic member 
34) Itself Is not the essential feature of the Invention. The essential feature of the invention resides in the feedback 
20 control. The defonm compensation Is an optional feature. 

[0342] in the first embodiment and the second emt>odiment. equivalent altering the order of calculation may t>e made 
on the block diagrams illustrated. 

[0343] In the first embodiment and the second embodiment although the present invention has been described with 
reference to the first embodiment of the application proposed earlier, the present Invention may be added to the second 
^5 embodiment and on in the application proposed earlier. 

[0344] In the first embodiment and the second embodiment, although the present invention has been described with 
reference to a biped robot, the present invention should not be limited to that and can be applied to other legged mobile 
robots. 

30 INDUSTRIAL FIELD IN WHICH THE INVENTION IS APPLICABLE 

[0345] According to the present invention, it becomes possible to control the floor reaction forces acting on the legged 
mobile robot, without causing the interference to occur, easily and appropriately. In other words, even if a control whfeh 
is dose to the combination of the two- leg-compliance control and the ankle-compliance control proposed earlier, is 
39 conducted, no control interference occurs and hence, the actual total floor reaction force and the actual foot floor 
reaction force do not deviate from desirable values, and no oscillatbn occurs. 

[0346] Further, the system can realize the posture stabilization control of the legged mobile robot easily and by 
conducting the compliance control on the force component of the actual floor reactton force acting on the legged mobile 
robot, ft can decrease the foot-landing impact and enhance the contactability of robot foot with the floor, thereby enabling 
V 4a to prevent the slippage or spinning that can occur during walking from happening. Furthermore, by controlling the 
Jntemal foroe components (a combination of components that do not influence on the actual total floor reaction force) 
generated by the actual foot floor reaction force acting on the robot Independently, it can improve the posture stability, 
thereby enabling to effectively prevent the slippage from happening and to decrease the load to be exerted on the Joint 
actuators. 

4^ [0347] Furthemiore, the system can appropriately control the floor reaction force acting on the legged mobile robot, 
even when walking on the floor having not only a slant or undulatton extending over a relatively long distance, but also 
on an unexpected local slant or level difference, without being affected thereby. The system can decrease the load to 
be exerted on the actuators of the legged mobile robot. 
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Claims 



A system for controlling a legged mobile robot having at least a body and a plurality of legs each connected to the 
body through a first Joint and having a foot connected U> its distal end through a second Joint, comprising: 

a. gait generating nrreans for generating a gait of the robot Including at least a motion pattem including at least 
a desired position and a posture of the foot, and a desired pattern of a total floor reaction foroe acting on the 
robot; 
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b. desired foot floor reaction force central point determining means for detemrilnlng a desired foot floor reaction 
force central point Indicative of a point of action on the foot when the total floor reaction force In the generated 
gait is distribittad to each of the feet; 

c. actual floor reaction force detecting means for detecting an actual floor reaction force acting on the fool; 

d. foot rotating amount determining means for determining a foot rotating amount for rotating the foot based 
on at least the detected actual floor reaction force; 

e. first foot posltion/posturs correcting means for correcting the desired position and/or the posture of the foot 
such that the position and/or the posture of the foot rotates based on the determined foot rotating amount; 

f . compensating displacement calculating means for calculating a compensating displacement of the foot 
based on at least the detected actual floor reaction force; 

g. second foot position/posture correcting means for correcting the desired position and/or the posture of the 
foot based on the calculated compensating displacement; and 

h. joint displacement means for displacing the first joint and the second joint of the robot based on at least the 
corrected position and/or posture of the foot con-ected by the first foot position/posture correcting means and 
the second foot position posture oonrecting means. 

2. A system according to claim 1 , wherein the foot rotating amount detenmining means calculates a moment acting 
about the detemnined desired foot floor reaction force central point and determines the foot rotating amount for 
rotating the foot based on at least the calculated moment and the compensating displacenrient calculating means 
detemnines a force component of an actual total floor reaction force based on the detected actual floor reaction 
force to calculate an error between the determined force component and a force component of the total floor 
reaction force in the generated gait and calculates the compensating displacement based on the calculated error. 

3. A system according to dalm 1 or 2, wherein the first foot posltion/l^osture correcting means con-ects the desired 
position andA>r the posture of the fool based on the detennined foot rotating amount such that the position and/or 
the posture of the.foot rotates about the desired foot floor reaction force central point or thereabout. 

4. A system according to dalm 1 or 2, wherein the first foot position/joosture oonrecting means conecls the desfa^ 
position and^or the posture of the foot based on the detemiined foot rotating amount such that the position and/or 
the posture of the foot rotates about the desired foot floor reaction force central point or thereabout. 

5. A system according to any of claims 1 to 4, further including: 

I. foot moving amount detennining means for detenmining at least one of a moment of total floor reaction 
force actually acting on the robot, and a moment obtained by subtracting a moment of the floor reaction force 
acting on the foot from the moment of total floor reaction force actually acting on the robot, and for determining a 
foot moving arrraunt for moving the foot based on at least the determined moment; 

and wherein the f iret foot position/posture correcting means corrects the desired position and/or the posture of the 
foot based on the determined foot rotating amount and the determined foot moving amount. 

6. A system according to any of claims 1 to 6, wherein a moment of a compensaUng total floor reaction force for 
posture stabilization to be added to the desired pattem of the total floor reaction force is determined, and wherein 
the foot rotating amount determining means and/or the foot moving amount detenmining means detemilnes the 
foot rotating amount and/or the foot moving amount based on at least the detected actual floor reaction force and 
the detemilned moment of the compensating total floor reaction force for posture stabilization. 

7. A system according to any of clabms 1 to 6, wherein the moment of the compensating total floor reaction force for 
posture stabilization Is detenmined based on at least an inclination error of the robot 

a. A system according to any of claims 1 to 7, wherein the compensating displacement calculating means includes: 

j. body acceleration detecting means for detecting a body acceleration of the robot; and 
k. compensating total floor reaction force's force component calculating means for calculating a force compo- 
nent of the compensating total floor reaction force for posture stabilization based on the detected body accel- 
eration; 

and calculates the compensating displacement of the foot based on a difference obtained by aubtractlng the enor 
from the calculated force component of the compensating total floor reaction force. 
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9. A system according to claim 8, wherein the compensating displacement ccriculating means distributes the com- 
pensating displacement of the foot to each of the feet by multiplying the difference by a predetemnlned weight 

1 0. A system according to claim 9, wherein the compensating displacement calculating means malces the weight zero 
5 when the foot is lifted. 

11. A system according to claim 9, wherein the compensating displacement calculating means varies the weight in 
response to a frequency of the force component of the actual total floor reaction force. 

10 1 2. A system according to any of claims 1 to 1 1 , wherein the displacement calculating means calculates the compen- 
sating displacement of the foot with respect to a direction of gravity. 

13. A system according to any of claims 1 to 1 1 , wherein the displacement calculating means calculates the compen- 
sating displacement of the foot with respect to a direction of a segment connecting a center of gravity of the robot 
f 9 and a desired total floor reaction force central point 

14^ A system according to any of claims 8 to 13, whersln the force component of the compensating total floor reaction 
force Is set to zero or thereabout. 

^ 15. A system according to ciedm 1 , wherein the compensating displacement calculating means determines an Internal 
force component, which does not Influence an actual total floor reaction force, from the detected actual floor reaction 
force to calculate an error between the determined Internal force component and an internal force component In 
the generated gait, and calculates the compensating displacement of each of the feet based on the calculated envr. 

A system according to claim 3, wherein the foot rotating amount determining means determines the foot rotating 
amount for rotating the foot based on at least the detected actual floor reaction force, and the first foot position/ 
posture correcting means corrects the desired position and/or the posture of the foot based on the detenmined foot 
rotating amount such that the position and/or the posture of the foot rotates about the desired foot floor reaction 
force central point or thereabout. ^ 

A system according to claim 1 5, wherein the first foot position/posture correcting means corrects the desired po- 
sition and/or the posture of the foot based on the detennined foot rotating amount such that the position and/or 
the posture of the foot rotates about the desired foot floor reaction force central point or thereabout 

3s 18. A system according to any of claims 15 to 1 7, further Including: 

1 . foot moving amount determining means for detenriining at least one of a moment of total floor reaction 
force actually acting on the robot, and a moment obtained by subtracting a moment of the floor reaction force 
acting on the foot from the moment of total floor reaction force actually acting on the robot, and for determining a 
foot moving amount for moving the foot based on at least the determined moment; 
J 4o and wherein the first foot position/posture correcting mear)s corrects the desired position and/or the posture 

of the foot based on the detemilned foot rotating amount and the detennined foot moving amount. 

19. A system according to any of claims 15 to 18, wherein a moment of a compensating total floor reaction force for 
posture stabilization to be added to the desired pattem of the total floor reaction force is detennined, and wherein 

^5 the foot rotating amount detenninlng means and/or the foot moving amount detennlning means determines the 

foot rotating amount and/or the foot moving amount based on at least the detected actual floor reaction force and 
the detemnlned moment of the compensating total floor reaction force for posture stabilization. 

20. A system according to any of claims 15 to 19, wherein a moment of a compensating total floor reaction force for 
so posture stabilization is detennined based on at least an inclination error of the robot 

21. A system according to any of claims 15 to 20, wherein the compensating displacement calculating means distrib- 
utes the compensating displacement of the foot to each of the feet by multiplying the difference by a predetennlned 
weight 

22. A system according to claim 21 , wherein the prsdetenmlned weight has time-varying characteristics and/or fre- 
quency characteristics. 
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